mirror of
https://github.com/FEX-Emu/linux.git
synced 2024-12-22 17:33:01 +00:00
0bf2461fdd
Fix switch initialization to ensure that all switches have default routing disabled. This guarantees that no unexpected RapidIO packets arrive to the default port set by reset and there is no default routing destination until it is properly configured by software. This update also unifies handling of unmapped destinations by tsi57x, IDT Gen1 and IDT Gen2 switches. Signed-off-by: Alexandre 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: <stable@kernel.org> [2.6.37+] Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
431 lines
11 KiB
C
431 lines
11 KiB
C
/*
|
|
* IDT CPS Gen.2 Serial RapidIO switch family support
|
|
*
|
|
* Copyright 2010 Integrated Device Technology, Inc.
|
|
* Alexandre Bounine <alexandre.bounine@idt.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
|
* option) any later version.
|
|
*/
|
|
|
|
#include <linux/rio.h>
|
|
#include <linux/rio_drv.h>
|
|
#include <linux/rio_ids.h>
|
|
#include <linux/delay.h>
|
|
#include "../rio.h"
|
|
|
|
#define LOCAL_RTE_CONF_DESTID_SEL 0x010070
|
|
#define LOCAL_RTE_CONF_DESTID_SEL_PSEL 0x0000001f
|
|
|
|
#define IDT_LT_ERR_REPORT_EN 0x03100c
|
|
|
|
#define IDT_PORT_ERR_REPORT_EN(n) (0x031044 + (n)*0x40)
|
|
#define IDT_PORT_ERR_REPORT_EN_BC 0x03ff04
|
|
|
|
#define IDT_PORT_ISERR_REPORT_EN(n) (0x03104C + (n)*0x40)
|
|
#define IDT_PORT_ISERR_REPORT_EN_BC 0x03ff0c
|
|
#define IDT_PORT_INIT_TX_ACQUIRED 0x00000020
|
|
|
|
#define IDT_LANE_ERR_REPORT_EN(n) (0x038010 + (n)*0x100)
|
|
#define IDT_LANE_ERR_REPORT_EN_BC 0x03ff10
|
|
|
|
#define IDT_DEV_CTRL_1 0xf2000c
|
|
#define IDT_DEV_CTRL_1_GENPW 0x02000000
|
|
#define IDT_DEV_CTRL_1_PRSTBEH 0x00000001
|
|
|
|
#define IDT_CFGBLK_ERR_CAPTURE_EN 0x020008
|
|
#define IDT_CFGBLK_ERR_REPORT 0xf20014
|
|
#define IDT_CFGBLK_ERR_REPORT_GENPW 0x00000002
|
|
|
|
#define IDT_AUX_PORT_ERR_CAP_EN 0x020000
|
|
#define IDT_AUX_ERR_REPORT_EN 0xf20018
|
|
#define IDT_AUX_PORT_ERR_LOG_I2C 0x00000002
|
|
#define IDT_AUX_PORT_ERR_LOG_JTAG 0x00000001
|
|
|
|
#define IDT_ISLTL_ADDRESS_CAP 0x021014
|
|
|
|
#define IDT_RIO_DOMAIN 0xf20020
|
|
#define IDT_RIO_DOMAIN_MASK 0x000000ff
|
|
|
|
#define IDT_PW_INFO_CSR 0xf20024
|
|
|
|
#define IDT_SOFT_RESET 0xf20040
|
|
#define IDT_SOFT_RESET_REQ 0x00030097
|
|
|
|
#define IDT_I2C_MCTRL 0xf20050
|
|
#define IDT_I2C_MCTRL_GENPW 0x04000000
|
|
|
|
#define IDT_JTAG_CTRL 0xf2005c
|
|
#define IDT_JTAG_CTRL_GENPW 0x00000002
|
|
|
|
#define IDT_LANE_CTRL(n) (0xff8000 + (n)*0x100)
|
|
#define IDT_LANE_CTRL_BC 0xffff00
|
|
#define IDT_LANE_CTRL_GENPW 0x00200000
|
|
#define IDT_LANE_DFE_1_BC 0xffff18
|
|
#define IDT_LANE_DFE_2_BC 0xffff1c
|
|
|
|
#define IDT_PORT_OPS(n) (0xf40004 + (n)*0x100)
|
|
#define IDT_PORT_OPS_GENPW 0x08000000
|
|
#define IDT_PORT_OPS_PL_ELOG 0x00000040
|
|
#define IDT_PORT_OPS_LL_ELOG 0x00000020
|
|
#define IDT_PORT_OPS_LT_ELOG 0x00000010
|
|
#define IDT_PORT_OPS_BC 0xf4ff04
|
|
|
|
#define IDT_PORT_ISERR_DET(n) (0xf40008 + (n)*0x100)
|
|
|
|
#define IDT_ERR_CAP 0xfd0000
|
|
#define IDT_ERR_CAP_LOG_OVERWR 0x00000004
|
|
|
|
#define IDT_ERR_RD 0xfd0004
|
|
|
|
#define IDT_DEFAULT_ROUTE 0xde
|
|
#define IDT_NO_ROUTE 0xdf
|
|
|
|
static int
|
|
idtg2_route_add_entry(struct rio_mport *mport, u16 destid, u8 hopcount,
|
|
u16 table, u16 route_destid, u8 route_port)
|
|
{
|
|
/*
|
|
* Select routing table to update
|
|
*/
|
|
if (table == RIO_GLOBAL_TABLE)
|
|
table = 0;
|
|
else
|
|
table++;
|
|
|
|
if (route_port == RIO_INVALID_ROUTE)
|
|
route_port = IDT_DEFAULT_ROUTE;
|
|
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
LOCAL_RTE_CONF_DESTID_SEL, table);
|
|
|
|
/*
|
|
* Program destination port for the specified destID
|
|
*/
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
RIO_STD_RTE_CONF_DESTID_SEL_CSR,
|
|
(u32)route_destid);
|
|
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
RIO_STD_RTE_CONF_PORT_SEL_CSR,
|
|
(u32)route_port);
|
|
udelay(10);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtg2_route_get_entry(struct rio_mport *mport, u16 destid, u8 hopcount,
|
|
u16 table, u16 route_destid, u8 *route_port)
|
|
{
|
|
u32 result;
|
|
|
|
/*
|
|
* Select routing table to read
|
|
*/
|
|
if (table == RIO_GLOBAL_TABLE)
|
|
table = 0;
|
|
else
|
|
table++;
|
|
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
LOCAL_RTE_CONF_DESTID_SEL, table);
|
|
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
RIO_STD_RTE_CONF_DESTID_SEL_CSR,
|
|
route_destid);
|
|
|
|
rio_mport_read_config_32(mport, destid, hopcount,
|
|
RIO_STD_RTE_CONF_PORT_SEL_CSR, &result);
|
|
|
|
if (IDT_DEFAULT_ROUTE == (u8)result || IDT_NO_ROUTE == (u8)result)
|
|
*route_port = RIO_INVALID_ROUTE;
|
|
else
|
|
*route_port = (u8)result;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtg2_route_clr_table(struct rio_mport *mport, u16 destid, u8 hopcount,
|
|
u16 table)
|
|
{
|
|
u32 i;
|
|
|
|
/*
|
|
* Select routing table to read
|
|
*/
|
|
if (table == RIO_GLOBAL_TABLE)
|
|
table = 0;
|
|
else
|
|
table++;
|
|
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
LOCAL_RTE_CONF_DESTID_SEL, table);
|
|
|
|
for (i = RIO_STD_RTE_CONF_EXTCFGEN;
|
|
i <= (RIO_STD_RTE_CONF_EXTCFGEN | 0xff);) {
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
RIO_STD_RTE_CONF_DESTID_SEL_CSR, i);
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
RIO_STD_RTE_CONF_PORT_SEL_CSR,
|
|
(IDT_DEFAULT_ROUTE << 24) | (IDT_DEFAULT_ROUTE << 16) |
|
|
(IDT_DEFAULT_ROUTE << 8) | IDT_DEFAULT_ROUTE);
|
|
i += 4;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int
|
|
idtg2_set_domain(struct rio_mport *mport, u16 destid, u8 hopcount,
|
|
u8 sw_domain)
|
|
{
|
|
/*
|
|
* Switch domain configuration operates only at global level
|
|
*/
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
IDT_RIO_DOMAIN, (u32)sw_domain);
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtg2_get_domain(struct rio_mport *mport, u16 destid, u8 hopcount,
|
|
u8 *sw_domain)
|
|
{
|
|
u32 regval;
|
|
|
|
/*
|
|
* Switch domain configuration operates only at global level
|
|
*/
|
|
rio_mport_read_config_32(mport, destid, hopcount,
|
|
IDT_RIO_DOMAIN, ®val);
|
|
|
|
*sw_domain = (u8)(regval & 0xff);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtg2_em_init(struct rio_dev *rdev)
|
|
{
|
|
u32 regval;
|
|
int i, tmp;
|
|
|
|
/*
|
|
* This routine performs device-specific initialization only.
|
|
* All standard EM configuration should be performed at upper level.
|
|
*/
|
|
|
|
pr_debug("RIO: %s [%d:%d]\n", __func__, rdev->destid, rdev->hopcount);
|
|
|
|
/* Set Port-Write info CSR: PRIO=3 and CRF=1 */
|
|
rio_write_config_32(rdev, IDT_PW_INFO_CSR, 0x0000e000);
|
|
|
|
/*
|
|
* Configure LT LAYER error reporting.
|
|
*/
|
|
|
|
/* Enable standard (RIO.p8) error reporting */
|
|
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_read_config_32(rdev, IDT_DEV_CTRL_1, ®val);
|
|
rio_write_config_32(rdev, IDT_DEV_CTRL_1,
|
|
regval | IDT_DEV_CTRL_1_GENPW | IDT_DEV_CTRL_1_PRSTBEH);
|
|
|
|
/*
|
|
* Configure PORT error reporting.
|
|
*/
|
|
|
|
/* Report all RIO.p8 errors supported by device */
|
|
rio_write_config_32(rdev, IDT_PORT_ERR_REPORT_EN_BC, 0x807e8037);
|
|
|
|
/* Configure reporting of implementation specific errors/events */
|
|
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_read_config_32(rdev, IDT_PORT_OPS(i), ®val);
|
|
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_write_config_32(rdev, IDT_ERR_CAP, IDT_ERR_CAP_LOG_OVERWR);
|
|
|
|
/*
|
|
* Configure LANE error reporting.
|
|
*/
|
|
|
|
/* Disable line error reporting */
|
|
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_read_config_32(rdev, IDT_LANE_CTRL(i), ®val);
|
|
rio_write_config_32(rdev, IDT_LANE_CTRL(i),
|
|
regval | IDT_LANE_CTRL_GENPW);
|
|
}
|
|
|
|
/*
|
|
* Configure AUX error reporting.
|
|
*/
|
|
|
|
/* Disable JTAG and I2C Error capture */
|
|
rio_write_config_32(rdev, IDT_AUX_PORT_ERR_CAP_EN, 0);
|
|
|
|
/* Disable JTAG and I2C Error reporting/logging */
|
|
rio_write_config_32(rdev, IDT_AUX_ERR_REPORT_EN, 0);
|
|
|
|
/* Disable Port-Write notification from JTAG */
|
|
rio_write_config_32(rdev, IDT_JTAG_CTRL, 0);
|
|
|
|
/* Disable Port-Write notification from I2C */
|
|
rio_read_config_32(rdev, IDT_I2C_MCTRL, ®val);
|
|
rio_write_config_32(rdev, IDT_I2C_MCTRL, regval & ~IDT_I2C_MCTRL_GENPW);
|
|
|
|
/*
|
|
* Configure CFG_BLK error reporting.
|
|
*/
|
|
|
|
/* Disable Configuration Block error capture */
|
|
rio_write_config_32(rdev, IDT_CFGBLK_ERR_CAPTURE_EN, 0);
|
|
|
|
/* Disable Port-Writes for Configuration Block error reporting */
|
|
rio_read_config_32(rdev, IDT_CFGBLK_ERR_REPORT, ®val);
|
|
rio_write_config_32(rdev, IDT_CFGBLK_ERR_REPORT,
|
|
regval & ~IDT_CFGBLK_ERR_REPORT_GENPW);
|
|
|
|
/* set TVAL = ~50us */
|
|
rio_write_config_32(rdev,
|
|
rdev->phys_efptr + RIO_PORT_LINKTO_CTL_CSR, 0x8e << 8);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtg2_em_handler(struct rio_dev *rdev, u8 portnum)
|
|
{
|
|
u32 regval, em_perrdet, em_ltlerrdet;
|
|
|
|
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_read_config_32(rdev,
|
|
IDT_ISLTL_ADDRESS_CAP, ®val);
|
|
|
|
pr_debug("RIO: %s Implementation Specific LTL errors" \
|
|
" 0x%x @(0x%x)\n",
|
|
rio_name(rdev), em_ltlerrdet, regval);
|
|
|
|
/* Clear implementation specific address capture CSR */
|
|
rio_write_config_32(rdev, IDT_ISLTL_ADDRESS_CAP, 0);
|
|
|
|
}
|
|
}
|
|
|
|
rio_read_config_32(rdev,
|
|
rdev->em_efptr + RIO_EM_PN_ERR_DETECT(portnum), &em_perrdet);
|
|
if (em_perrdet) {
|
|
/* Service Port-Level Error(s) */
|
|
if (em_perrdet & REM_PED_IMPL_SPEC) {
|
|
/* Implementation Specific port error reported */
|
|
|
|
/* Get IS errors reported */
|
|
rio_read_config_32(rdev,
|
|
IDT_PORT_ISERR_DET(portnum), ®val);
|
|
|
|
pr_debug("RIO: %s Implementation Specific Port" \
|
|
" errors 0x%x\n", rio_name(rdev), regval);
|
|
|
|
/* Clear all implementation specific events */
|
|
rio_write_config_32(rdev,
|
|
IDT_PORT_ISERR_DET(portnum), 0);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t
|
|
idtg2_show_errlog(struct device *dev, struct device_attribute *attr, char *buf)
|
|
{
|
|
struct rio_dev *rdev = to_rio_dev(dev);
|
|
ssize_t len = 0;
|
|
u32 regval;
|
|
|
|
while (!rio_read_config_32(rdev, IDT_ERR_RD, ®val)) {
|
|
if (!regval) /* 0 = end of log */
|
|
break;
|
|
len += snprintf(buf + len, PAGE_SIZE - len,
|
|
"%08x\n", regval);
|
|
if (len >= (PAGE_SIZE - 10))
|
|
break;
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
static DEVICE_ATTR(errlog, S_IRUGO, idtg2_show_errlog, NULL);
|
|
|
|
static int idtg2_sysfs(struct rio_dev *rdev, int create)
|
|
{
|
|
struct device *dev = &rdev->dev;
|
|
int err = 0;
|
|
|
|
if (create == RIO_SW_SYSFS_CREATE) {
|
|
/* Initialize sysfs entries */
|
|
err = device_create_file(dev, &dev_attr_errlog);
|
|
if (err)
|
|
dev_err(dev, "Unable create sysfs errlog file\n");
|
|
} else
|
|
device_remove_file(dev, &dev_attr_errlog);
|
|
|
|
return err;
|
|
}
|
|
|
|
static int idtg2_switch_init(struct rio_dev *rdev, int do_enum)
|
|
{
|
|
pr_debug("RIO: %s for %s\n", __func__, rio_name(rdev));
|
|
rdev->rswitch->add_entry = idtg2_route_add_entry;
|
|
rdev->rswitch->get_entry = idtg2_route_get_entry;
|
|
rdev->rswitch->clr_table = idtg2_route_clr_table;
|
|
rdev->rswitch->set_domain = idtg2_set_domain;
|
|
rdev->rswitch->get_domain = idtg2_get_domain;
|
|
rdev->rswitch->em_init = idtg2_em_init;
|
|
rdev->rswitch->em_handle = idtg2_em_handler;
|
|
rdev->rswitch->sw_sysfs = idtg2_sysfs;
|
|
|
|
if (do_enum) {
|
|
/* Ensure that default routing is disabled on startup */
|
|
rio_write_config_32(rdev,
|
|
RIO_STD_RTE_DEFAULT_PORT, IDT_NO_ROUTE);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS1848, idtg2_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS1616, idtg2_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTVPS1616, idtg2_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTSPS1616, idtg2_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS1432, idtg2_switch_init);
|