[linux-block.git] / drivers / rapidio / switches / idtcps.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_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_NO_ROUTE == (u8)result)
			result = RIO_INVALID_ROUTE;

		*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,
				(RIO_INVALID_ROUTE << 24) |
				(RIO_INVALID_ROUTE << 16) |
				(RIO_INVALID_ROUTE << 8) | RIO_INVALID_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, &regval);

	*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;

	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);
Commit	Line	Data
07590ff0 AB	1	/*
	2	* IDT CPS RapidIO switches support
	3	*
058f88d6 AB	4	* Copyright 2009-2010 Integrated Device Technology, Inc.
058f88d6 AB	5	* Alexandre Bounine <alexandre.bounine@idt.com>
07590ff0 AB	6	*
	7	* This program is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License as published by the
	9	* Free Software Foundation; either version 2 of the License, or (at your
	10	* option) any later version.
	11	*/
	12
	13	#include <linux/rio.h>
	14	#include <linux/rio_drv.h>
	15	#include <linux/rio_ids.h>
	16	#include "../rio.h"
	17
	18	#define CPS_NO_ROUTE 0xdf
	19
7a88d628 AB	20	#define IDTCPS_RIO_DOMAIN 0xf20020
7a88d628 AB	21
07590ff0 AB	22	static int
	23	idtcps_route_add_entry(struct rio_mport *mport, u16 destid, u8 hopcount,
	24	u16 table, u16 route_destid, u8 route_port)
	25	{
	26	u32 result;
	27
	28	if (table == RIO_GLOBAL_TABLE) {
	29	rio_mport_write_config_32(mport, destid, hopcount,
	30	RIO_STD_RTE_CONF_DESTID_SEL_CSR, route_destid);
	31
	32	rio_mport_read_config_32(mport, destid, hopcount,
	33	RIO_STD_RTE_CONF_PORT_SEL_CSR, &result);
	34
	35	result = (0xffffff00 & result) \| (u32)route_port;
	36	rio_mport_write_config_32(mport, destid, hopcount,
	37	RIO_STD_RTE_CONF_PORT_SEL_CSR, result);
	38	}
	39
	40	return 0;
	41	}
	42
	43	static int
	44	idtcps_route_get_entry(struct rio_mport *mport, u16 destid, u8 hopcount,
	45	u16 table, u16 route_destid, u8 *route_port)
	46	{
	47	u32 result;
	48
	49	if (table == RIO_GLOBAL_TABLE) {
	50	rio_mport_write_config_32(mport, destid, hopcount,
	51	RIO_STD_RTE_CONF_DESTID_SEL_CSR, route_destid);
	52
	53	rio_mport_read_config_32(mport, destid, hopcount,
	54	RIO_STD_RTE_CONF_PORT_SEL_CSR, &result);
	55
	56	if (CPS_NO_ROUTE == (u8)result)
	57	result = RIO_INVALID_ROUTE;
	58
	59	*route_port = (u8)result;
	60	}
	61
	62	return 0;
	63	}
	64
	65	static int
	66	idtcps_route_clr_table(struct rio_mport *mport, u16 destid, u8 hopcount,
	67	u16 table)
	68	{
	69	u32 i;
	70
	71	if (table == RIO_GLOBAL_TABLE) {
	72	for (i = 0x80000000; i <= 0x800000ff;) {
	73	rio_mport_write_config_32(mport, destid, hopcount,
	74	RIO_STD_RTE_CONF_DESTID_SEL_CSR, i);
	75	rio_mport_write_config_32(mport, destid, hopcount,
	76	RIO_STD_RTE_CONF_PORT_SEL_CSR,
	77	(RIO_INVALID_ROUTE << 24) \|
	78	(RIO_INVALID_ROUTE << 16) \|
	79	(RIO_INVALID_ROUTE << 8) \| RIO_INVALID_ROUTE);
	80	i += 4;
	81	}
	82	}
	83
	84	return 0;
	85	}
86
7a88d628 AB	87	static int
	88	idtcps_set_domain(struct rio_mport *mport, u16 destid, u8 hopcount,
	89	u8 sw_domain)
	90	{
	91	/*
	92	* Switch domain configuration operates only at global level
	93	*/
	94	rio_mport_write_config_32(mport, destid, hopcount,
	95	IDTCPS_RIO_DOMAIN, (u32)sw_domain);
	96	return 0;
	97	}
	98
	99	static int
	100	idtcps_get_domain(struct rio_mport *mport, u16 destid, u8 hopcount,
	101	u8 *sw_domain)
	102	{
	103	u32 regval;
	104
	105	/*
	106	* Switch domain configuration operates only at global level
	107	*/
	108	rio_mport_read_config_32(mport, destid, hopcount,
	109	IDTCPS_RIO_DOMAIN, &regval);
	110
	111	*sw_domain = (u8)(regval & 0xff);
	112
	113	return 0;
	114	}
	115
058f88d6 AB	116	static int idtcps_switch_init(struct rio_dev *rdev, int do_enum)
	117	{
	118	pr_debug("RIO: %s for %s\n", __func__, rio_name(rdev));
	119	rdev->rswitch->add_entry = idtcps_route_add_entry;
	120	rdev->rswitch->get_entry = idtcps_route_get_entry;
	121	rdev->rswitch->clr_table = idtcps_route_clr_table;
7a88d628 AB	122	rdev->rswitch->set_domain = idtcps_set_domain;
7a88d628 AB	123	rdev->rswitch->get_domain = idtcps_get_domain;
058f88d6 AB	124	rdev->rswitch->em_init = NULL;
	125	rdev->rswitch->em_handle = NULL;
	126
	127	return 0;
	128	}
	129
	130	DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS6Q, idtcps_switch_init);
	131	DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS8, idtcps_switch_init);
	132	DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS10Q, idtcps_switch_init);
	133	DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS12, idtcps_switch_init);
	134	DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS16, idtcps_switch_init);
	135	DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDT70K200, idtcps_switch_init);