forked from luck/tmp_suning_uos_patched
a93192a5d2
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: 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: Micha Nelissen <micha@neli.hopto.org> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
144 lines
3.8 KiB
C
144 lines
3.8 KiB
C
/*
|
|
* IDT CPS RapidIO switches support
|
|
*
|
|
* Copyright 2009-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 "../rio.h"
|
|
|
|
#define CPS_DEFAULT_ROUTE 0xde
|
|
#define CPS_NO_ROUTE 0xdf
|
|
|
|
#define IDTCPS_RIO_DOMAIN 0xf20020
|
|
|
|
static int
|
|
idtcps_route_add_entry(struct rio_mport *mport, u16 destid, u8 hopcount,
|
|
u16 table, u16 route_destid, u8 route_port)
|
|
{
|
|
u32 result;
|
|
|
|
if (table == RIO_GLOBAL_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);
|
|
|
|
result = (0xffffff00 & result) | (u32)route_port;
|
|
rio_mport_write_config_32(mport, destid, hopcount,
|
|
RIO_STD_RTE_CONF_PORT_SEL_CSR, result);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtcps_route_get_entry(struct rio_mport *mport, u16 destid, u8 hopcount,
|
|
u16 table, u16 route_destid, u8 *route_port)
|
|
{
|
|
u32 result;
|
|
|
|
if (table == RIO_GLOBAL_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 (CPS_DEFAULT_ROUTE == (u8)result ||
|
|
CPS_NO_ROUTE == (u8)result)
|
|
*route_port = RIO_INVALID_ROUTE;
|
|
else
|
|
*route_port = (u8)result;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtcps_route_clr_table(struct rio_mport *mport, u16 destid, u8 hopcount,
|
|
u16 table)
|
|
{
|
|
u32 i;
|
|
|
|
if (table == RIO_GLOBAL_TABLE) {
|
|
for (i = 0x80000000; i <= 0x800000ff;) {
|
|
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,
|
|
(CPS_DEFAULT_ROUTE << 24) |
|
|
(CPS_DEFAULT_ROUTE << 16) |
|
|
(CPS_DEFAULT_ROUTE << 8) | CPS_DEFAULT_ROUTE);
|
|
i += 4;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtcps_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,
|
|
IDTCPS_RIO_DOMAIN, (u32)sw_domain);
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
idtcps_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,
|
|
IDTCPS_RIO_DOMAIN, ®val);
|
|
|
|
*sw_domain = (u8)(regval & 0xff);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int idtcps_switch_init(struct rio_dev *rdev, int do_enum)
|
|
{
|
|
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;
|
|
rdev->rswitch->clr_table = idtcps_route_clr_table;
|
|
rdev->rswitch->set_domain = idtcps_set_domain;
|
|
rdev->rswitch->get_domain = idtcps_get_domain;
|
|
rdev->rswitch->em_init = NULL;
|
|
rdev->rswitch->em_handle = NULL;
|
|
|
|
if (do_enum) {
|
|
/* set TVAL = ~50us */
|
|
rio_write_config_32(rdev,
|
|
rdev->phys_efptr + RIO_PORT_LINKTO_CTL_CSR, 0x8e << 8);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS6Q, idtcps_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS8, idtcps_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS10Q, idtcps_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS12, idtcps_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS16, idtcps_switch_init);
|
|
DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDT70K200, idtcps_switch_init);
|