mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-03 17:40:04 +00:00
![Thomas Gleixner](/assets/img/avatar_default.png)
Based on 1 normalized pattern(s): 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 extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 3029 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070032.746973796@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
199 lines
4.7 KiB
C
199 lines
4.7 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* IDT CPS RapidIO switches support
|
|
*
|
|
* Copyright 2009-2010 Integrated Device Technology, Inc.
|
|
* Alexandre Bounine <alexandre.bounine@idt.com>
|
|
*/
|
|
|
|
#include <linux/rio.h>
|
|
#include <linux/rio_drv.h>
|
|
#include <linux/rio_ids.h>
|
|
#include <linux/module.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 (route_port == RIO_INVALID_ROUTE)
|
|
route_port = CPS_DEFAULT_ROUTE;
|
|
|
|
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 struct rio_switch_ops idtcps_switch_ops = {
|
|
.owner = THIS_MODULE,
|
|
.add_entry = idtcps_route_add_entry,
|
|
.get_entry = idtcps_route_get_entry,
|
|
.clr_table = idtcps_route_clr_table,
|
|
.set_domain = idtcps_set_domain,
|
|
.get_domain = idtcps_get_domain,
|
|
.em_init = NULL,
|
|
.em_handle = NULL,
|
|
};
|
|
|
|
static int idtcps_probe(struct rio_dev *rdev, const struct rio_device_id *id)
|
|
{
|
|
pr_debug("RIO: %s for %s\n", __func__, rio_name(rdev));
|
|
|
|
spin_lock(&rdev->rswitch->lock);
|
|
|
|
if (rdev->rswitch->ops) {
|
|
spin_unlock(&rdev->rswitch->lock);
|
|
return -EINVAL;
|
|
}
|
|
|
|
rdev->rswitch->ops = &idtcps_switch_ops;
|
|
|
|
if (rdev->do_enum) {
|
|
/* set TVAL = ~50us */
|
|
rio_write_config_32(rdev,
|
|
rdev->phys_efptr + RIO_PORT_LINKTO_CTL_CSR, 0x8e << 8);
|
|
/* Ensure that default routing is disabled on startup */
|
|
rio_write_config_32(rdev,
|
|
RIO_STD_RTE_DEFAULT_PORT, CPS_NO_ROUTE);
|
|
}
|
|
|
|
spin_unlock(&rdev->rswitch->lock);
|
|
return 0;
|
|
}
|
|
|
|
static void idtcps_remove(struct rio_dev *rdev)
|
|
{
|
|
pr_debug("RIO: %s for %s\n", __func__, rio_name(rdev));
|
|
spin_lock(&rdev->rswitch->lock);
|
|
if (rdev->rswitch->ops != &idtcps_switch_ops) {
|
|
spin_unlock(&rdev->rswitch->lock);
|
|
return;
|
|
}
|
|
rdev->rswitch->ops = NULL;
|
|
spin_unlock(&rdev->rswitch->lock);
|
|
}
|
|
|
|
static const struct rio_device_id idtcps_id_table[] = {
|
|
{RIO_DEVICE(RIO_DID_IDTCPS6Q, RIO_VID_IDT)},
|
|
{RIO_DEVICE(RIO_DID_IDTCPS8, RIO_VID_IDT)},
|
|
{RIO_DEVICE(RIO_DID_IDTCPS10Q, RIO_VID_IDT)},
|
|
{RIO_DEVICE(RIO_DID_IDTCPS12, RIO_VID_IDT)},
|
|
{RIO_DEVICE(RIO_DID_IDTCPS16, RIO_VID_IDT)},
|
|
{RIO_DEVICE(RIO_DID_IDT70K200, RIO_VID_IDT)},
|
|
{ 0, } /* terminate list */
|
|
};
|
|
|
|
static struct rio_driver idtcps_driver = {
|
|
.name = "idtcps",
|
|
.id_table = idtcps_id_table,
|
|
.probe = idtcps_probe,
|
|
.remove = idtcps_remove,
|
|
};
|
|
|
|
static int __init idtcps_init(void)
|
|
{
|
|
return rio_register_driver(&idtcps_driver);
|
|
}
|
|
|
|
static void __exit idtcps_exit(void)
|
|
{
|
|
rio_unregister_driver(&idtcps_driver);
|
|
}
|
|
|
|
device_initcall(idtcps_init);
|
|
module_exit(idtcps_exit);
|
|
|
|
MODULE_DESCRIPTION("IDT CPS Gen.1 Serial RapidIO switch family driver");
|
|
MODULE_AUTHOR("Integrated Device Technology, Inc.");
|
|
MODULE_LICENSE("GPL");
|