1 /* 2 * IDT CPS RapidIO switches support 3 * 4 * Copyright 2009-2010 Integrated Device Technology, Inc. 5 * Alexandre Bounine <alexandre.bounine@idt.com> 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_DEFAULT_ROUTE 0xde 19 #define CPS_NO_ROUTE 0xdf 20 21 #define IDTCPS_RIO_DOMAIN 0xf20020 22 23 static int 24 idtcps_route_add_entry(struct rio_mport *mport, u16 destid, u8 hopcount, 25 u16 table, u16 route_destid, u8 route_port) 26 { 27 u32 result; 28 29 if (route_port == RIO_INVALID_ROUTE) 30 route_port = CPS_DEFAULT_ROUTE; 31 32 if (table == RIO_GLOBAL_TABLE) { 33 rio_mport_write_config_32(mport, destid, hopcount, 34 RIO_STD_RTE_CONF_DESTID_SEL_CSR, route_destid); 35 36 rio_mport_read_config_32(mport, destid, hopcount, 37 RIO_STD_RTE_CONF_PORT_SEL_CSR, &result); 38 39 result = (0xffffff00 & result) | (u32)route_port; 40 rio_mport_write_config_32(mport, destid, hopcount, 41 RIO_STD_RTE_CONF_PORT_SEL_CSR, result); 42 } 43 44 return 0; 45 } 46 47 static int 48 idtcps_route_get_entry(struct rio_mport *mport, u16 destid, u8 hopcount, 49 u16 table, u16 route_destid, u8 *route_port) 50 { 51 u32 result; 52 53 if (table == RIO_GLOBAL_TABLE) { 54 rio_mport_write_config_32(mport, destid, hopcount, 55 RIO_STD_RTE_CONF_DESTID_SEL_CSR, route_destid); 56 57 rio_mport_read_config_32(mport, destid, hopcount, 58 RIO_STD_RTE_CONF_PORT_SEL_CSR, &result); 59 60 if (CPS_DEFAULT_ROUTE == (u8)result || 61 CPS_NO_ROUTE == (u8)result) 62 *route_port = RIO_INVALID_ROUTE; 63 else 64 *route_port = (u8)result; 65 } 66 67 return 0; 68 } 69 70 static int 71 idtcps_route_clr_table(struct rio_mport *mport, u16 destid, u8 hopcount, 72 u16 table) 73 { 74 u32 i; 75 76 if (table == RIO_GLOBAL_TABLE) { 77 for (i = 0x80000000; i <= 0x800000ff;) { 78 rio_mport_write_config_32(mport, destid, hopcount, 79 RIO_STD_RTE_CONF_DESTID_SEL_CSR, i); 80 rio_mport_write_config_32(mport, destid, hopcount, 81 RIO_STD_RTE_CONF_PORT_SEL_CSR, 82 (CPS_DEFAULT_ROUTE << 24) | 83 (CPS_DEFAULT_ROUTE << 16) | 84 (CPS_DEFAULT_ROUTE << 8) | CPS_DEFAULT_ROUTE); 85 i += 4; 86 } 87 } 88 89 return 0; 90 } 91 92 static int 93 idtcps_set_domain(struct rio_mport *mport, u16 destid, u8 hopcount, 94 u8 sw_domain) 95 { 96 /* 97 * Switch domain configuration operates only at global level 98 */ 99 rio_mport_write_config_32(mport, destid, hopcount, 100 IDTCPS_RIO_DOMAIN, (u32)sw_domain); 101 return 0; 102 } 103 104 static int 105 idtcps_get_domain(struct rio_mport *mport, u16 destid, u8 hopcount, 106 u8 *sw_domain) 107 { 108 u32 regval; 109 110 /* 111 * Switch domain configuration operates only at global level 112 */ 113 rio_mport_read_config_32(mport, destid, hopcount, 114 IDTCPS_RIO_DOMAIN, ®val); 115 116 *sw_domain = (u8)(regval & 0xff); 117 118 return 0; 119 } 120 121 static int idtcps_switch_init(struct rio_dev *rdev, int do_enum) 122 { 123 pr_debug("RIO: %s for %s\n", __func__, rio_name(rdev)); 124 rdev->rswitch->add_entry = idtcps_route_add_entry; 125 rdev->rswitch->get_entry = idtcps_route_get_entry; 126 rdev->rswitch->clr_table = idtcps_route_clr_table; 127 rdev->rswitch->set_domain = idtcps_set_domain; 128 rdev->rswitch->get_domain = idtcps_get_domain; 129 rdev->rswitch->em_init = NULL; 130 rdev->rswitch->em_handle = NULL; 131 132 if (do_enum) { 133 /* set TVAL = ~50us */ 134 rio_write_config_32(rdev, 135 rdev->phys_efptr + RIO_PORT_LINKTO_CTL_CSR, 0x8e << 8); 136 /* Ensure that default routing is disabled on startup */ 137 rio_write_config_32(rdev, 138 RIO_STD_RTE_DEFAULT_PORT, CPS_NO_ROUTE); 139 } 140 141 return 0; 142 } 143 144 DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS6Q, idtcps_switch_init); 145 DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS8, idtcps_switch_init); 146 DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS10Q, idtcps_switch_init); 147 DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS12, idtcps_switch_init); 148 DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDTCPS16, idtcps_switch_init); 149 DECLARE_RIO_SWITCH_INIT(RIO_VID_IDT, RIO_DID_IDT70K200, idtcps_switch_init); 150