Commit a93192a5 authored by Alexandre Bounine's avatar Alexandre Bounine Committed by Linus Torvalds
Browse files

rapidio: use common destid storage for endpoints and switches 



Change code to use one storage location common for switches and endpoints.
This eliminates unnecessary device type checks during basic access
operations.  Logic that assigns destid to RIO devices stays unchanged - as
before, switches use an associated destid because they do not have their
own.

Signed-off-by: default avatarAlexandre Bounine <alexandre.bounine@idt.com>
Cc: Kumar Gala <galak@kernel.crashing.org>
Cc: Matt Porter <mporter@kernel.crashing.org>
Cc: Li Yang <leoli@freescale.com>
Cc: Thomas Moll <thomas.moll@sysgo.com>
Cc: Micha Nelissen <micha@neli.hopto.org>
Signed-off-by: default avatarAndrew Morton <akpm@linux-foundation.org>
Signed-off-by: default avatarLinus Torvalds <torvalds@linux-foundation.org>
parent e6d7202b

drivers/rapidio/rio-scan.c

+43 −41
Original line number Diff line number Diff line
@@ -437,9 +437,15 @@ static struct rio_dev __devinit *rio_setup_device(struct rio_net *net, 
				next_destid++;

		} else

			rdev->destid = rio_get_device_id(port, destid, hopcount);

	} else

		/* Switch device has an associated destID */

		rdev->destid = RIO_INVALID_DESTID;



		rdev->hopcount = 0xff;

	} else {

		/* Switch device has an associated destID which

		 * will be adjusted later

		 */

		rdev->destid = destid;

		rdev->hopcount = hopcount;

	}



	/* If a PE has both switch and other functions, show it as a switch */

	if (rio_is_switch(rdev)) {
@@ -450,8 +456,6 @@ static struct rio_dev __devinit *rio_setup_device(struct rio_net *net, 
		if (!rswitch)

			goto cleanup;

		rswitch->switchid = next_switchid;

		rswitch->hopcount = hopcount;

		rswitch->destid = destid;

		rswitch->port_ok = 0;

		rswitch->route_table = kzalloc(sizeof(u8)*

					RIO_MAX_ROUTE_ENTRIES(port->sys_size),
@@ -632,8 +636,7 @@ rio_unlock_device(struct rio_mport *port, u16 destid, u8 hopcount) 


/**

 * rio_route_add_entry- Add a route entry to a switch routing table

 * @mport: Master port to send transaction

 * @rswitch: Switch device

 * @rdev: RIO device

 * @table: Routing table ID

 * @route_destid: Destination ID to be routed

 * @route_port: Port number to be routed
@@ -647,31 +650,31 @@ rio_unlock_device(struct rio_mport *port, u16 destid, u8 hopcount) 
 * on failure.

 */

static int

rio_route_add_entry(struct rio_mport *mport, struct rio_switch *rswitch,

rio_route_add_entry(struct rio_dev *rdev,

		    u16 table, u16 route_destid, u8 route_port, int lock)

{

	int rc;



	if (lock) {

		rc = rio_lock_device(mport, rswitch->destid,

				     rswitch->hopcount, 1000);

		rc = rio_lock_device(rdev->net->hport, rdev->destid,

				     rdev->hopcount, 1000);

		if (rc)

			return rc;

	}



	rc = rswitch->add_entry(mport, rswitch->destid,

					rswitch->hopcount, table,

	rc = rdev->rswitch->add_entry(rdev->net->hport, rdev->destid,

				      rdev->hopcount, table,

				      route_destid, route_port);

	if (lock)

		rio_unlock_device(mport, rswitch->destid, rswitch->hopcount);

		rio_unlock_device(rdev->net->hport, rdev->destid,

				  rdev->hopcount);



	return rc;

}



/**

 * rio_route_get_entry- Read a route entry in a switch routing table

 * @mport: Master port to send transaction

 * @rswitch: Switch device

 * @rdev: RIO device

 * @table: Routing table ID

 * @route_destid: Destination ID to be routed

 * @route_port: Pointer to read port number into
@@ -685,23 +688,24 @@ rio_route_add_entry(struct rio_mport *mport, struct rio_switch *rswitch, 
 * on failure.

 */

static int

rio_route_get_entry(struct rio_mport *mport, struct rio_switch *rswitch, u16 table,

rio_route_get_entry(struct rio_dev *rdev, u16 table,

		    u16 route_destid, u8 *route_port, int lock)

{

	int rc;



	if (lock) {

		rc = rio_lock_device(mport, rswitch->destid,

				     rswitch->hopcount, 1000);

		rc = rio_lock_device(rdev->net->hport, rdev->destid,

				     rdev->hopcount, 1000);

		if (rc)

			return rc;

	}



	rc = rswitch->get_entry(mport, rswitch->destid,

					rswitch->hopcount, table,

	rc = rdev->rswitch->get_entry(rdev->net->hport, rdev->destid,

				      rdev->hopcount, table,

				      route_destid, route_port);

	if (lock)

		rio_unlock_device(mport, rswitch->destid, rswitch->hopcount);

		rio_unlock_device(rdev->net->hport, rdev->destid,

				  rdev->hopcount);



	return rc;

}
@@ -811,14 +815,14 @@ static int __devinit rio_enum_peer(struct rio_net *net, struct rio_mport *port, 
	if (rio_is_switch(rdev)) {

		next_switchid++;

		sw_inport = RIO_GET_PORT_NUM(rdev->swpinfo);

		rio_route_add_entry(port, rdev->rswitch, RIO_GLOBAL_TABLE,

		rio_route_add_entry(rdev, RIO_GLOBAL_TABLE,

				    port->host_deviceid, sw_inport, 0);

		rdev->rswitch->route_table[port->host_deviceid] = sw_inport;



		for (destid = 0; destid < next_destid; destid++) {

			if (destid == port->host_deviceid)

				continue;

			rio_route_add_entry(port, rdev->rswitch, RIO_GLOBAL_TABLE,

			rio_route_add_entry(rdev, RIO_GLOBAL_TABLE,

					    destid, sw_inport, 0);

			rdev->rswitch->route_table[destid] = sw_inport;

		}
@@ -850,8 +854,7 @@ static int __devinit rio_enum_peer(struct rio_net *net, struct rio_mport *port, 
				    "RIO: scanning device on port %d\n",

				    port_num);

				rdev->rswitch->port_ok |= (1 << port_num);

				rio_route_add_entry(port, rdev->rswitch,

						RIO_GLOBAL_TABLE,

				rio_route_add_entry(rdev, RIO_GLOBAL_TABLE,

						RIO_ANY_DESTID(port->sys_size),

						port_num, 0);
@@ -865,7 +868,7 @@ static int __devinit rio_enum_peer(struct rio_net *net, struct rio_mport *port, 
					     destid < next_destid; destid++) {

						if (destid == port->host_deviceid)

							continue;

						rio_route_add_entry(port, rdev->rswitch,

						rio_route_add_entry(rdev,

								    RIO_GLOBAL_TABLE,

								    destid,

								    port_num,
@@ -904,7 +907,7 @@ static int __devinit rio_enum_peer(struct rio_net *net, struct rio_mport *port, 
				next_destid++;

		}



		rdev->rswitch->destid = sw_destid;

		rdev->destid = sw_destid;

	} else

		pr_debug("RIO: found %s (vid %4.4x did %4.4x)\n",

		    rio_name(rdev), rdev->vid, rdev->did);
@@ -958,7 +961,7 @@ rio_disc_peer(struct rio_net *net, struct rio_mport *port, u16 destid, 
		next_switchid++;



		/* Associated destid is how we accessed this switch */

		rdev->rswitch->destid = destid;

		rdev->destid = destid;



		pr_debug(

		    "RIO: found %s (vid %4.4x did %4.4x) with %d ports\n",
@@ -981,7 +984,7 @@ rio_disc_peer(struct rio_net *net, struct rio_mport *port, u16 destid, 
				for (ndestid = 0;

				     ndestid < RIO_ANY_DESTID(port->sys_size);

				     ndestid++) {

					rio_route_get_entry(port, rdev->rswitch,

					rio_route_get_entry(rdev,

							    RIO_GLOBAL_TABLE,

							    ndestid,

							    &route_port, 0);
@@ -1076,7 +1079,7 @@ static void rio_update_route_tables(struct rio_mport *port) 


	list_for_each_entry(rdev, &rio_devices, global_list) {



		destid = (rio_is_switch(rdev))?rdev->rswitch->destid:rdev->destid;

		destid = rdev->destid;



		list_for_each_entry(rswitch, &rio_switches, node) {
@@ -1085,13 +1088,13 @@ static void rio_update_route_tables(struct rio_mport *port) 


			if (RIO_INVALID_ROUTE == rswitch->route_table[destid]) {

				/* Skip if destid ends in empty switch*/

				if (rswitch->destid == destid)

				if (rswitch->rdev->destid == destid)

					continue;



				sport = RIO_GET_PORT_NUM(rswitch->rdev->swpinfo);



				if (rswitch->add_entry)	{

					rio_route_add_entry(port, rswitch,

					rio_route_add_entry(rswitch->rdev,

						RIO_GLOBAL_TABLE, destid,

						sport, 0);

					rswitch->route_table[destid] = sport;
@@ -1203,21 +1206,20 @@ static void rio_build_route_tables(void) 


	list_for_each_entry(rdev, &rio_devices, global_list)

		if (rio_is_switch(rdev)) {

			rio_lock_device(rdev->net->hport, rdev->rswitch->destid,

					rdev->rswitch->hopcount, 1000);

			rio_lock_device(rdev->net->hport, rdev->destid,

					rdev->hopcount, 1000);

			for (i = 0;

			     i < RIO_MAX_ROUTE_ENTRIES(rdev->net->hport->sys_size);

			     i++) {

				if (rio_route_get_entry

				    (rdev->net->hport, rdev->rswitch,

				if (rio_route_get_entry(rdev,

					RIO_GLOBAL_TABLE, i, &sport, 0) < 0)

					continue;

				rdev->rswitch->route_table[i] = sport;

			}



			rio_unlock_device(rdev->net->hport,

					  rdev->rswitch->destid,

					  rdev->rswitch->hopcount);

					  rdev->destid,

					  rdev->hopcount);

		}

}

drivers/rapidio/rio.c

+22 −52
Original line number Diff line number Diff line
@@ -471,16 +471,9 @@ exit: 
 */

int rio_set_port_lockout(struct rio_dev *rdev, u32 pnum, int lock)

{

	u8 hopcount = 0xff;

	u16 destid = rdev->destid;

	u32 regval;



	if (rdev->rswitch) {

		destid = rdev->rswitch->destid;

		hopcount = rdev->rswitch->hopcount;

	}



	rio_mport_read_config_32(rdev->net->hport, destid, hopcount,

	rio_read_config_32(rdev,

				 rdev->phys_efptr + RIO_PORT_N_CTL_CSR(pnum),

				 &regval);

	if (lock)
@@ -488,7 +481,7 @@ int rio_set_port_lockout(struct rio_dev *rdev, u32 pnum, int lock) 
	else

		regval &= ~RIO_PORT_N_CTL_LOCKOUT;



	rio_mport_write_config_32(rdev->net->hport, destid, hopcount,

	rio_write_config_32(rdev,

				  rdev->phys_efptr + RIO_PORT_N_CTL_CSR(pnum),

				  regval);

	return 0;
@@ -507,7 +500,7 @@ static int 
rio_chk_dev_route(struct rio_dev *rdev, struct rio_dev **nrdev, int *npnum)

{

	u32 result;

	int p_port, dstid, rc = -EIO;

	int p_port, rc = -EIO;

	struct rio_dev *prev = NULL;



	/* Find switch with failed RIO link */
@@ -522,9 +515,7 @@ rio_chk_dev_route(struct rio_dev *rdev, struct rio_dev **nrdev, int *npnum) 
	if (prev == NULL)

		goto err_out;



	dstid = (rdev->pef & RIO_PEF_SWITCH) ?

			rdev->rswitch->destid : rdev->destid;

	p_port = prev->rswitch->route_table[dstid];

	p_port = prev->rswitch->route_table[rdev->destid];



	if (p_port != RIO_INVALID_ROUTE) {

		pr_debug("RIO: link failed on [%s]-P%d\n",
@@ -567,15 +558,8 @@ rio_mport_chk_dev_access(struct rio_mport *mport, u16 destid, u8 hopcount) 
 */

static int rio_chk_dev_access(struct rio_dev *rdev)

{

	u8 hopcount = 0xff;

	u16 destid = rdev->destid;



	if (rdev->rswitch) {

		destid = rdev->rswitch->destid;

		hopcount = rdev->rswitch->hopcount;

	}



	return rio_mport_chk_dev_access(rdev->net->hport, destid, hopcount);

	return rio_mport_chk_dev_access(rdev->net->hport,

					rdev->destid, rdev->hopcount);

}



/**
@@ -588,23 +572,20 @@ static int rio_chk_dev_access(struct rio_dev *rdev) 
static int

rio_get_input_status(struct rio_dev *rdev, int pnum, u32 *lnkresp)

{

	struct rio_mport *mport = rdev->net->hport;

	u16 destid = rdev->rswitch->destid;

	u8 hopcount = rdev->rswitch->hopcount;

	u32 regval;

	int checkcount;



	if (lnkresp) {

		/* Read from link maintenance response register

		 * to clear valid bit */

		rio_mport_read_config_32(mport, destid, hopcount,

		rio_read_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_N_MNT_RSP_CSR(pnum),

			&regval);

		udelay(50);

	}



	/* Issue Input-status command */

	rio_mport_write_config_32(mport, destid, hopcount,

	rio_write_config_32(rdev,

		rdev->phys_efptr + RIO_PORT_N_MNT_REQ_CSR(pnum),

		RIO_MNT_REQ_CMD_IS);
@@ -615,7 +596,7 @@ rio_get_input_status(struct rio_dev *rdev, int pnum, u32 *lnkresp) 
	checkcount = 3;

	while (checkcount--) {

		udelay(50);

		rio_mport_read_config_32(mport, destid, hopcount,

		rio_read_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_N_MNT_RSP_CSR(pnum),

			&regval);

		if (regval & RIO_PORT_N_MNT_RSP_RVAL) {
@@ -635,15 +616,12 @@ rio_get_input_status(struct rio_dev *rdev, int pnum, u32 *lnkresp) 
 */

static int rio_clr_err_stopped(struct rio_dev *rdev, u32 pnum, u32 err_status)

{

	struct rio_mport *mport = rdev->net->hport;

	u16 destid = rdev->rswitch->destid;

	u8 hopcount = rdev->rswitch->hopcount;

	struct rio_dev *nextdev = rdev->rswitch->nextdev[pnum];

	u32 regval;

	u32 far_ackid, far_linkstat, near_ackid;



	if (err_status == 0)

		rio_mport_read_config_32(mport, destid, hopcount,

		rio_read_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_N_ERR_STS_CSR(pnum),

			&err_status);
@@ -661,7 +639,7 @@ static int rio_clr_err_stopped(struct rio_dev *rdev, u32 pnum, u32 err_status) 
			 pnum, regval);

		far_ackid = (regval & RIO_PORT_N_MNT_RSP_ASTAT) >> 5;

		far_linkstat = regval & RIO_PORT_N_MNT_RSP_LSTAT;

		rio_mport_read_config_32(mport, destid, hopcount,

		rio_read_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_N_ACK_STS_CSR(pnum),

			&regval);

		pr_debug("RIO_EM: SP%d_ACK_STS_CSR=0x%08x\n", pnum, regval);
@@ -679,9 +657,8 @@ static int rio_clr_err_stopped(struct rio_dev *rdev, u32 pnum, u32 err_status) 
			/* Align near outstanding/outbound ackIDs with

			 * far inbound.

			 */

			rio_mport_write_config_32(mport, destid,

				hopcount, rdev->phys_efptr +

					RIO_PORT_N_ACK_STS_CSR(pnum),

			rio_write_config_32(rdev,

				rdev->phys_efptr + RIO_PORT_N_ACK_STS_CSR(pnum),

				(near_ackid << 24) |

					(far_ackid << 8) | far_ackid);

			/* Align far outstanding/outbound ackIDs with
@@ -698,7 +675,7 @@ static int rio_clr_err_stopped(struct rio_dev *rdev, u32 pnum, u32 err_status) 
				pr_debug("RIO_EM: Invalid nextdev pointer (NULL)\n");

		}

rd_err:

		rio_mport_read_config_32(mport, destid, hopcount,

		rio_read_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_N_ERR_STS_CSR(pnum),

			&err_status);

		pr_debug("RIO_EM: SP%d_ERR_STS_CSR=0x%08x\n", pnum, err_status);
@@ -710,7 +687,7 @@ rd_err: 
				     RIO_GET_PORT_NUM(nextdev->swpinfo), NULL);

		udelay(50);



		rio_mport_read_config_32(mport, destid, hopcount,

		rio_read_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_N_ERR_STS_CSR(pnum),

			&err_status);

		pr_debug("RIO_EM: SP%d_ERR_STS_CSR=0x%08x\n", pnum, err_status);
@@ -730,9 +707,6 @@ rd_err: 
int rio_inb_pwrite_handler(union rio_pw_msg *pw_msg)

{

	struct rio_dev *rdev;

	struct rio_mport *mport;

	u8 hopcount;

	u16 destid;

	u32 err_status, em_perrdet, em_ltlerrdet;

	int rc, portnum;
@@ -800,17 +774,13 @@ int rio_inb_pwrite_handler(union rio_pw_msg *pw_msg) 
		return 0;

	}



	mport = rdev->net->hport;

	destid = rdev->rswitch->destid;

	hopcount = rdev->rswitch->hopcount;



	/*

	 * Process the port-write notification from switch

	 */

	if (rdev->rswitch->em_handle)

		rdev->rswitch->em_handle(rdev, portnum);



	rio_mport_read_config_32(mport, destid, hopcount,

	rio_read_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_N_ERR_STS_CSR(portnum),

			&err_status);

	pr_debug("RIO_PW: SP%d_ERR_STS_CSR=0x%08x\n", portnum, err_status);
@@ -840,7 +810,7 @@ int rio_inb_pwrite_handler(union rio_pw_msg *pw_msg) 
			rdev->rswitch->port_ok &= ~(1 << portnum);

			rio_set_port_lockout(rdev, portnum, 1);



			rio_mport_write_config_32(mport, destid, hopcount,

			rio_write_config_32(rdev,

				rdev->phys_efptr +

					RIO_PORT_N_ACK_STS_CSR(portnum),

				RIO_PORT_N_ACK_CLEAR);
@@ -851,28 +821,28 @@ int rio_inb_pwrite_handler(union rio_pw_msg *pw_msg) 
		}

	}



	rio_mport_read_config_32(mport, destid, hopcount,

	rio_read_config_32(rdev,

		rdev->em_efptr + RIO_EM_PN_ERR_DETECT(portnum), &em_perrdet);

	if (em_perrdet) {

		pr_debug("RIO_PW: RIO_EM_P%d_ERR_DETECT=0x%08x\n",

			 portnum, em_perrdet);

		/* Clear EM Port N Error Detect CSR */

		rio_mport_write_config_32(mport, destid, hopcount,

		rio_write_config_32(rdev,

			rdev->em_efptr + RIO_EM_PN_ERR_DETECT(portnum), 0);

	}



	rio_mport_read_config_32(mport, destid, hopcount,

	rio_read_config_32(rdev,

		rdev->em_efptr + RIO_EM_LTL_ERR_DETECT, &em_ltlerrdet);

	if (em_ltlerrdet) {

		pr_debug("RIO_PW: RIO_EM_LTL_ERR_DETECT=0x%08x\n",

			 em_ltlerrdet);

		/* Clear EM L/T Layer Error Detect CSR */

		rio_mport_write_config_32(mport, destid, hopcount,

		rio_write_config_32(rdev,

			rdev->em_efptr + RIO_EM_LTL_ERR_DETECT, 0);

	}



	/* Clear remaining error bits and Port-Write Pending bit */

	rio_mport_write_config_32(mport, destid, hopcount,

	rio_write_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_N_ERR_STS_CSR(portnum),

			err_status);

drivers/rapidio/switches/idt_gen2.c

+32 −61
Original line number Diff line number Diff line
@@ -209,9 +209,6 @@ idtg2_get_domain(struct rio_mport *mport, u16 destid, u8 hopcount, 
static int

idtg2_em_init(struct rio_dev *rdev)

{

	struct rio_mport *mport = rdev->net->hport;

	u16 destid = rdev->rswitch->destid;

	u8 hopcount = rdev->rswitch->hopcount;

	u32 regval;

	int i, tmp;
@@ -220,29 +217,25 @@ idtg2_em_init(struct rio_dev *rdev) 
	 * All standard EM configuration should be performed at upper level.

	 */



	pr_debug("RIO: %s [%d:%d]\n", __func__, destid, hopcount);

	pr_debug("RIO: %s [%d:%d]\n", __func__, rdev->destid, rdev->hopcount);



	/* Set Port-Write info CSR: PRIO=3 and CRF=1 */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_PW_INFO_CSR, 0x0000e000);

	rio_write_config_32(rdev, IDT_PW_INFO_CSR, 0x0000e000);



	/*

	 * Configure LT LAYER error reporting.

	 */



	/* Enable standard (RIO.p8) error reporting */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_LT_ERR_REPORT_EN,

	rio_write_config_32(rdev, IDT_LT_ERR_REPORT_EN,

			REM_LTL_ERR_ILLTRAN | REM_LTL_ERR_UNSOLR |

			REM_LTL_ERR_UNSUPTR);



	/* Use Port-Writes for LT layer error reporting.

	 * Enable per-port reset

	 */

	rio_mport_read_config_32(mport, destid, hopcount,

			IDT_DEV_CTRL_1, &regval);

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_DEV_CTRL_1,

	rio_read_config_32(rdev, IDT_DEV_CTRL_1, &regval);

	rio_write_config_32(rdev, IDT_DEV_CTRL_1,

			regval | IDT_DEV_CTRL_1_GENPW | IDT_DEV_CTRL_1_PRSTBEH);



	/*
@@ -250,45 +243,40 @@ idtg2_em_init(struct rio_dev *rdev) 
	 */



	/* Report all RIO.p8 errors supported by device */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_PORT_ERR_REPORT_EN_BC, 0x807e8037);

	rio_write_config_32(rdev, IDT_PORT_ERR_REPORT_EN_BC, 0x807e8037);



	/* Configure reporting of implementation specific errors/events */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_PORT_ISERR_REPORT_EN_BC, IDT_PORT_INIT_TX_ACQUIRED);

	rio_write_config_32(rdev, IDT_PORT_ISERR_REPORT_EN_BC,

			    IDT_PORT_INIT_TX_ACQUIRED);



	/* Use Port-Writes for port error reporting and enable error logging */

	tmp = RIO_GET_TOTAL_PORTS(rdev->swpinfo);

	for (i = 0; i < tmp; i++) {

		rio_mport_read_config_32(mport, destid, hopcount,

				IDT_PORT_OPS(i), &regval);

		rio_mport_write_config_32(mport, destid, hopcount,

		rio_read_config_32(rdev, IDT_PORT_OPS(i), &regval);

		rio_write_config_32(rdev,

				IDT_PORT_OPS(i), regval | IDT_PORT_OPS_GENPW |

				IDT_PORT_OPS_PL_ELOG |

				IDT_PORT_OPS_LL_ELOG |

				IDT_PORT_OPS_LT_ELOG);

	}

	/* Overwrite error log if full */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_ERR_CAP, IDT_ERR_CAP_LOG_OVERWR);

	rio_write_config_32(rdev, IDT_ERR_CAP, IDT_ERR_CAP_LOG_OVERWR);



	/*

	 * Configure LANE error reporting.

	 */



	/* Disable line error reporting */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_LANE_ERR_REPORT_EN_BC, 0);

	rio_write_config_32(rdev, IDT_LANE_ERR_REPORT_EN_BC, 0);



	/* Use Port-Writes for lane error reporting (when enabled)

	 * (do per-lane update because lanes may have different configuration)

	 */

	tmp = (rdev->did == RIO_DID_IDTCPS1848) ? 48 : 16;

	for (i = 0; i < tmp; i++) {

		rio_mport_read_config_32(mport, destid, hopcount,

				IDT_LANE_CTRL(i), &regval);

		rio_mport_write_config_32(mport, destid, hopcount,

				IDT_LANE_CTRL(i), regval | IDT_LANE_CTRL_GENPW);

		rio_read_config_32(rdev, IDT_LANE_CTRL(i), &regval);

		rio_write_config_32(rdev, IDT_LANE_CTRL(i),

				    regval | IDT_LANE_CTRL_GENPW);

	}



	/*
@@ -296,41 +284,32 @@ idtg2_em_init(struct rio_dev *rdev) 
	 */



	/* Disable JTAG and I2C Error capture */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_AUX_PORT_ERR_CAP_EN, 0);

	rio_write_config_32(rdev, IDT_AUX_PORT_ERR_CAP_EN, 0);



	/* Disable JTAG and I2C Error reporting/logging */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_AUX_ERR_REPORT_EN, 0);

	rio_write_config_32(rdev, IDT_AUX_ERR_REPORT_EN, 0);



	/* Disable Port-Write notification from JTAG */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_JTAG_CTRL, 0);

	rio_write_config_32(rdev, IDT_JTAG_CTRL, 0);



	/* Disable Port-Write notification from I2C */

	rio_mport_read_config_32(mport, destid, hopcount,

			IDT_I2C_MCTRL, &regval);

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_I2C_MCTRL,

			regval & ~IDT_I2C_MCTRL_GENPW);

	rio_read_config_32(rdev, IDT_I2C_MCTRL, &regval);

	rio_write_config_32(rdev, IDT_I2C_MCTRL, regval & ~IDT_I2C_MCTRL_GENPW);



	/*

	 * Configure CFG_BLK error reporting.

	 */



	/* Disable Configuration Block error capture */

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_CFGBLK_ERR_CAPTURE_EN, 0);

	rio_write_config_32(rdev, IDT_CFGBLK_ERR_CAPTURE_EN, 0);



	/* Disable Port-Writes for Configuration Block error reporting */

	rio_mport_read_config_32(mport, destid, hopcount,

			IDT_CFGBLK_ERR_REPORT, &regval);

	rio_mport_write_config_32(mport, destid, hopcount,

			IDT_CFGBLK_ERR_REPORT,

	rio_read_config_32(rdev, IDT_CFGBLK_ERR_REPORT, &regval);

	rio_write_config_32(rdev, IDT_CFGBLK_ERR_REPORT,

			    regval & ~IDT_CFGBLK_ERR_REPORT_GENPW);



	/* set TVAL = ~50us */

	rio_mport_write_config_32(mport, destid, hopcount,

	rio_write_config_32(rdev,

		rdev->phys_efptr + RIO_PORT_LINKTO_CTL_CSR, 0x8e << 8);



	return 0;
@@ -339,18 +318,15 @@ idtg2_em_init(struct rio_dev *rdev) 
static int

idtg2_em_handler(struct rio_dev *rdev, u8 portnum)

{

	struct rio_mport *mport = rdev->net->hport;

	u16 destid = rdev->rswitch->destid;

	u8 hopcount = rdev->rswitch->hopcount;

	u32 regval, em_perrdet, em_ltlerrdet;



	rio_mport_read_config_32(mport, destid, hopcount,

	rio_read_config_32(rdev,

		rdev->em_efptr + RIO_EM_LTL_ERR_DETECT, &em_ltlerrdet);

	if (em_ltlerrdet) {

		/* Service Logical/Transport Layer Error(s) */

		if (em_ltlerrdet & REM_LTL_ERR_IMPSPEC) {

			/* Implementation specific error reported */

			rio_mport_read_config_32(mport, destid, hopcount,

			rio_read_config_32(rdev,

					IDT_ISLTL_ADDRESS_CAP, &regval);



			pr_debug("RIO: %s Implementation Specific LTL errors" \
@@ -358,13 +334,12 @@ idtg2_em_handler(struct rio_dev *rdev, u8 portnum) 
				 rio_name(rdev), em_ltlerrdet, regval);



			/* Clear implementation specific address capture CSR */

			rio_mport_write_config_32(mport, destid, hopcount,

					IDT_ISLTL_ADDRESS_CAP, 0);

			rio_write_config_32(rdev, IDT_ISLTL_ADDRESS_CAP, 0);



		}

	}



	rio_mport_read_config_32(mport, destid, hopcount,

	rio_read_config_32(rdev,

		rdev->em_efptr + RIO_EM_PN_ERR_DETECT(portnum), &em_perrdet);

	if (em_perrdet) {

		/* Service Port-Level Error(s) */
@@ -372,14 +347,14 @@ idtg2_em_handler(struct rio_dev *rdev, u8 portnum) 
			/* Implementation Specific port error reported */



			/* Get IS errors reported */

			rio_mport_read_config_32(mport, destid, hopcount,

			rio_read_config_32(rdev,

					IDT_PORT_ISERR_DET(portnum), &regval);



			pr_debug("RIO: %s Implementation Specific Port" \

				 " errors 0x%x\n", rio_name(rdev), regval);



			/* Clear all implementation specific events */

			rio_mport_write_config_32(mport, destid, hopcount,

			rio_write_config_32(rdev,

					IDT_PORT_ISERR_DET(portnum), 0);

		}

	}
@@ -391,14 +366,10 @@ static ssize_t 
idtg2_show_errlog(struct device *dev, struct device_attribute *attr, char *buf)

{

	struct rio_dev *rdev = to_rio_dev(dev);

	struct rio_mport *mport = rdev->net->hport;

	u16 destid = rdev->rswitch->destid;

	u8 hopcount = rdev->rswitch->hopcount;

	ssize_t len = 0;

	u32 regval;



	while (!rio_mport_read_config_32(mport, destid, hopcount,

					 IDT_ERR_RD, &regval)) {

	while (!rio_read_config_32(rdev, IDT_ERR_RD, &regval)) {

		if (!regval)    /* 0 = end of log */

			break;

		len += snprintf(buf + len, PAGE_SIZE - len,

drivers/rapidio/switches/idtcps.c

+1 −5
Original line number Diff line number Diff line
@@ -117,10 +117,6 @@ idtcps_get_domain(struct rio_mport *mport, u16 destid, u8 hopcount, 


static int idtcps_switch_init(struct rio_dev *rdev, int do_enum)

{

	struct rio_mport *mport = rdev->net->hport;

	u16 destid = rdev->rswitch->destid;

	u8 hopcount = rdev->rswitch->hopcount;



	pr_debug("RIO: %s for %s\n", __func__, rio_name(rdev));

	rdev->rswitch->add_entry = idtcps_route_add_entry;

	rdev->rswitch->get_entry = idtcps_route_get_entry;
@@ -132,7 +128,7 @@ static int idtcps_switch_init(struct rio_dev *rdev, int do_enum) 


	if (do_enum) {

		/* set TVAL = ~50us */

		rio_mport_write_config_32(mport, destid, hopcount,

		rio_write_config_32(rdev,

			rdev->phys_efptr + RIO_PORT_LINKTO_CTL_CSR, 0x8e << 8);

	}

drivers/rapidio/switches/tsi568.c

+4 −9
Original line number Diff line number Diff line
@@ -113,21 +113,16 @@ tsi568_route_clr_table(struct rio_mport *mport, u16 destid, u8 hopcount, 
static int

tsi568_em_init(struct rio_dev *rdev)

{

	struct rio_mport *mport = rdev->net->hport;

	u16 destid = rdev->rswitch->destid;

	u8 hopcount = rdev->rswitch->hopcount;

	u32 regval;

	int portnum;



	pr_debug("TSI568 %s [%d:%d]\n", __func__, destid, hopcount);

	pr_debug("TSI568 %s [%d:%d]\n", __func__, rdev->destid, rdev->hopcount);



	/* Make sure that Port-Writes are disabled (for all ports) */

	for (portnum = 0;

	     portnum < RIO_GET_TOTAL_PORTS(rdev->swpinfo); portnum++) {

		rio_mport_read_config_32(mport, destid, hopcount,

				TSI568_SP_MODE(portnum), &regval);

		rio_mport_write_config_32(mport, destid, hopcount,

				TSI568_SP_MODE(portnum),

		rio_read_config_32(rdev, TSI568_SP_MODE(portnum), &regval);

		rio_write_config_32(rdev, TSI568_SP_MODE(portnum),

				    regval | TSI568_SP_MODE_PW_DIS);

	}

CRA Git | Maintained and supported by SUSTech CRA and CCSE