Matt Porter | eb188d0 | 2005-11-07 01:00:17 -0800 | [diff] [blame] | 1 | /* |
| 2 | * RapidIO enumeration and discovery support |
| 3 | * |
| 4 | * Copyright 2005 MontaVista Software, Inc. |
| 5 | * Matt Porter <mporter@kernel.crashing.org> |
| 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/config.h> |
| 14 | #include <linux/types.h> |
| 15 | #include <linux/kernel.h> |
| 16 | |
| 17 | #include <linux/delay.h> |
Matt Porter | fa78cc5 | 2005-11-07 01:00:18 -0800 | [diff] [blame] | 18 | #include <linux/dma-mapping.h> |
Matt Porter | eb188d0 | 2005-11-07 01:00:17 -0800 | [diff] [blame] | 19 | #include <linux/init.h> |
| 20 | #include <linux/rio.h> |
| 21 | #include <linux/rio_drv.h> |
| 22 | #include <linux/rio_ids.h> |
| 23 | #include <linux/rio_regs.h> |
| 24 | #include <linux/module.h> |
| 25 | #include <linux/spinlock.h> |
| 26 | #include <linux/timer.h> |
| 27 | |
| 28 | #include "rio.h" |
| 29 | |
| 30 | LIST_HEAD(rio_devices); |
| 31 | static LIST_HEAD(rio_switches); |
| 32 | |
| 33 | #define RIO_ENUM_CMPL_MAGIC 0xdeadbeef |
| 34 | |
| 35 | static void rio_enum_timeout(unsigned long); |
| 36 | |
Matt Porter | fa78cc5 | 2005-11-07 01:00:18 -0800 | [diff] [blame] | 37 | DEFINE_SPINLOCK(rio_global_list_lock); |
| 38 | |
Matt Porter | eb188d0 | 2005-11-07 01:00:17 -0800 | [diff] [blame] | 39 | static int next_destid = 0; |
| 40 | static int next_switchid = 0; |
| 41 | static int next_net = 0; |
| 42 | |
| 43 | static struct timer_list rio_enum_timer = |
| 44 | TIMER_INITIALIZER(rio_enum_timeout, 0, 0); |
| 45 | |
| 46 | static int rio_mport_phys_table[] = { |
| 47 | RIO_EFB_PAR_EP_ID, |
| 48 | RIO_EFB_PAR_EP_REC_ID, |
| 49 | RIO_EFB_SER_EP_ID, |
| 50 | RIO_EFB_SER_EP_REC_ID, |
| 51 | -1, |
| 52 | }; |
| 53 | |
| 54 | static int rio_sport_phys_table[] = { |
| 55 | RIO_EFB_PAR_EP_FREE_ID, |
| 56 | RIO_EFB_SER_EP_FREE_ID, |
| 57 | -1, |
| 58 | }; |
| 59 | |
Matt Porter | eb188d0 | 2005-11-07 01:00:17 -0800 | [diff] [blame] | 60 | /** |
| 61 | * rio_get_device_id - Get the base/extended device id for a device |
| 62 | * @port: RIO master port |
| 63 | * @destid: Destination ID of device |
| 64 | * @hopcount: Hopcount to device |
| 65 | * |
| 66 | * Reads the base/extended device id from a device. Returns the |
| 67 | * 8/16-bit device ID. |
| 68 | */ |
| 69 | static u16 rio_get_device_id(struct rio_mport *port, u16 destid, u8 hopcount) |
| 70 | { |
| 71 | u32 result; |
| 72 | |
| 73 | rio_mport_read_config_32(port, destid, hopcount, RIO_DID_CSR, &result); |
| 74 | |
| 75 | return RIO_GET_DID(result); |
| 76 | } |
| 77 | |
| 78 | /** |
| 79 | * rio_set_device_id - Set the base/extended device id for a device |
| 80 | * @port: RIO master port |
| 81 | * @destid: Destination ID of device |
| 82 | * @hopcount: Hopcount to device |
| 83 | * @did: Device ID value to be written |
| 84 | * |
| 85 | * Writes the base/extended device id from a device. |
| 86 | */ |
Matt Porter | fa78cc5 | 2005-11-07 01:00:18 -0800 | [diff] [blame] | 87 | static void rio_set_device_id(struct rio_mport *port, u16 destid, u8 hopcount, u16 did) |
Matt Porter | eb188d0 | 2005-11-07 01:00:17 -0800 | [diff] [blame] | 88 | { |
| 89 | rio_mport_write_config_32(port, destid, hopcount, RIO_DID_CSR, |
| 90 | RIO_SET_DID(did)); |
| 91 | } |
| 92 | |
| 93 | /** |
| 94 | * rio_local_set_device_id - Set the base/extended device id for a port |
| 95 | * @port: RIO master port |
| 96 | * @did: Device ID value to be written |
| 97 | * |
| 98 | * Writes the base/extended device id from a device. |
| 99 | */ |
| 100 | static void rio_local_set_device_id(struct rio_mport *port, u16 did) |
| 101 | { |
| 102 | rio_local_write_config_32(port, RIO_DID_CSR, RIO_SET_DID(did)); |
| 103 | } |
| 104 | |
| 105 | /** |
| 106 | * rio_clear_locks- Release all host locks and signal enumeration complete |
| 107 | * @port: Master port to issue transaction |
| 108 | * |
| 109 | * Marks the component tag CSR on each device with the enumeration |
| 110 | * complete flag. When complete, it then release the host locks on |
| 111 | * each device. Returns 0 on success or %-EINVAL on failure. |
| 112 | */ |
| 113 | static int rio_clear_locks(struct rio_mport *port) |
| 114 | { |
| 115 | struct rio_dev *rdev; |
| 116 | u32 result; |
| 117 | int ret = 0; |
| 118 | |
| 119 | /* Write component tag CSR magic complete value */ |
| 120 | rio_local_write_config_32(port, RIO_COMPONENT_TAG_CSR, |
| 121 | RIO_ENUM_CMPL_MAGIC); |
| 122 | list_for_each_entry(rdev, &rio_devices, global_list) |
| 123 | rio_write_config_32(rdev, RIO_COMPONENT_TAG_CSR, |
| 124 | RIO_ENUM_CMPL_MAGIC); |
| 125 | |
| 126 | /* Release host device id locks */ |
| 127 | rio_local_write_config_32(port, RIO_HOST_DID_LOCK_CSR, |
| 128 | port->host_deviceid); |
| 129 | rio_local_read_config_32(port, RIO_HOST_DID_LOCK_CSR, &result); |
| 130 | if ((result & 0xffff) != 0xffff) { |
| 131 | printk(KERN_INFO |
| 132 | "RIO: badness when releasing host lock on master port, result %8.8x\n", |
| 133 | result); |
| 134 | ret = -EINVAL; |
| 135 | } |
| 136 | list_for_each_entry(rdev, &rio_devices, global_list) { |
| 137 | rio_write_config_32(rdev, RIO_HOST_DID_LOCK_CSR, |
| 138 | port->host_deviceid); |
| 139 | rio_read_config_32(rdev, RIO_HOST_DID_LOCK_CSR, &result); |
| 140 | if ((result & 0xffff) != 0xffff) { |
| 141 | printk(KERN_INFO |
| 142 | "RIO: badness when releasing host lock on vid %4.4x did %4.4x\n", |
| 143 | rdev->vid, rdev->did); |
| 144 | ret = -EINVAL; |
| 145 | } |
| 146 | } |
| 147 | |
| 148 | return ret; |
| 149 | } |
| 150 | |
| 151 | /** |
| 152 | * rio_enum_host- Set host lock and initialize host destination ID |
| 153 | * @port: Master port to issue transaction |
| 154 | * |
| 155 | * Sets the local host master port lock and destination ID register |
| 156 | * with the host device ID value. The host device ID value is provided |
| 157 | * by the platform. Returns %0 on success or %-1 on failure. |
| 158 | */ |
| 159 | static int rio_enum_host(struct rio_mport *port) |
| 160 | { |
| 161 | u32 result; |
| 162 | |
| 163 | /* Set master port host device id lock */ |
| 164 | rio_local_write_config_32(port, RIO_HOST_DID_LOCK_CSR, |
| 165 | port->host_deviceid); |
| 166 | |
| 167 | rio_local_read_config_32(port, RIO_HOST_DID_LOCK_CSR, &result); |
| 168 | if ((result & 0xffff) != port->host_deviceid) |
| 169 | return -1; |
| 170 | |
| 171 | /* Set master port destid and init destid ctr */ |
| 172 | rio_local_set_device_id(port, port->host_deviceid); |
| 173 | |
| 174 | if (next_destid == port->host_deviceid) |
| 175 | next_destid++; |
| 176 | |
| 177 | return 0; |
| 178 | } |
| 179 | |
| 180 | /** |
| 181 | * rio_device_has_destid- Test if a device contains a destination ID register |
| 182 | * @port: Master port to issue transaction |
| 183 | * @src_ops: RIO device source operations |
| 184 | * @dst_ops: RIO device destination operations |
| 185 | * |
| 186 | * Checks the provided @src_ops and @dst_ops for the necessary transaction |
| 187 | * capabilities that indicate whether or not a device will implement a |
| 188 | * destination ID register. Returns 1 if true or 0 if false. |
| 189 | */ |
| 190 | static int rio_device_has_destid(struct rio_mport *port, int src_ops, |
| 191 | int dst_ops) |
| 192 | { |
Matt Porter | fa78cc5 | 2005-11-07 01:00:18 -0800 | [diff] [blame] | 193 | u32 mask = RIO_OPS_READ | RIO_OPS_WRITE | RIO_OPS_ATOMIC_TST_SWP | RIO_OPS_ATOMIC_INC | RIO_OPS_ATOMIC_DEC | RIO_OPS_ATOMIC_SET | RIO_OPS_ATOMIC_CLR; |
| 194 | |
| 195 | return !!((src_ops | dst_ops) & mask); |
Matt Porter | eb188d0 | 2005-11-07 01:00:17 -0800 | [diff] [blame] | 196 | } |
| 197 | |
| 198 | /** |
| 199 | * rio_release_dev- Frees a RIO device struct |
| 200 | * @dev: LDM device associated with a RIO device struct |
| 201 | * |
| 202 | * Gets the RIO device struct associated a RIO device struct. |
| 203 | * The RIO device struct is freed. |
| 204 | */ |
| 205 | static void rio_release_dev(struct device *dev) |
| 206 | { |
| 207 | struct rio_dev *rdev; |
| 208 | |
| 209 | rdev = to_rio_dev(dev); |
| 210 | kfree(rdev); |
| 211 | } |
| 212 | |
| 213 | /** |
| 214 | * rio_is_switch- Tests if a RIO device has switch capabilities |
| 215 | * @rdev: RIO device |
| 216 | * |
| 217 | * Gets the RIO device Processing Element Features register |
| 218 | * contents and tests for switch capabilities. Returns 1 if |
| 219 | * the device is a switch or 0 if it is not a switch. |
| 220 | * The RIO device struct is freed. |
| 221 | */ |
| 222 | static int rio_is_switch(struct rio_dev *rdev) |
| 223 | { |
| 224 | if (rdev->pef & RIO_PEF_SWITCH) |
| 225 | return 1; |
| 226 | return 0; |
| 227 | } |
| 228 | |
| 229 | /** |
| 230 | * rio_route_set_ops- Sets routing operations for a particular vendor switch |
| 231 | * @rdev: RIO device |
| 232 | * |
| 233 | * Searches the RIO route ops table for known switch types. If the vid |
| 234 | * and did match a switch table entry, then set the add_entry() and |
| 235 | * get_entry() ops to the table entry values. |
| 236 | */ |
| 237 | static void rio_route_set_ops(struct rio_dev *rdev) |
| 238 | { |
| 239 | struct rio_route_ops *cur = __start_rio_route_ops; |
| 240 | struct rio_route_ops *end = __end_rio_route_ops; |
| 241 | |
| 242 | while (cur < end) { |
| 243 | if ((cur->vid == rdev->vid) && (cur->did == rdev->did)) { |
| 244 | pr_debug("RIO: adding routing ops for %s\n", rio_name(rdev)); |
| 245 | rdev->rswitch->add_entry = cur->add_hook; |
| 246 | rdev->rswitch->get_entry = cur->get_hook; |
| 247 | } |
| 248 | cur++; |
| 249 | } |
| 250 | |
| 251 | if (!rdev->rswitch->add_entry || !rdev->rswitch->get_entry) |
| 252 | printk(KERN_ERR "RIO: missing routing ops for %s\n", |
| 253 | rio_name(rdev)); |
| 254 | } |
| 255 | |
| 256 | /** |
| 257 | * rio_add_device- Adds a RIO device to the device model |
| 258 | * @rdev: RIO device |
| 259 | * |
| 260 | * Adds the RIO device to the global device list and adds the RIO |
| 261 | * device to the RIO device list. Creates the generic sysfs nodes |
| 262 | * for an RIO device. |
| 263 | */ |
| 264 | static void __devinit rio_add_device(struct rio_dev *rdev) |
| 265 | { |
| 266 | device_add(&rdev->dev); |
| 267 | |
| 268 | spin_lock(&rio_global_list_lock); |
| 269 | list_add_tail(&rdev->global_list, &rio_devices); |
| 270 | spin_unlock(&rio_global_list_lock); |
| 271 | |
| 272 | rio_create_sysfs_dev_files(rdev); |
| 273 | } |
| 274 | |
| 275 | /** |
| 276 | * rio_setup_device- Allocates and sets up a RIO device |
| 277 | * @net: RIO network |
| 278 | * @port: Master port to send transactions |
| 279 | * @destid: Current destination ID |
| 280 | * @hopcount: Current hopcount |
| 281 | * @do_enum: Enumeration/Discovery mode flag |
| 282 | * |
| 283 | * Allocates a RIO device and configures fields based on configuration |
| 284 | * space contents. If device has a destination ID register, a destination |
| 285 | * ID is either assigned in enumeration mode or read from configuration |
| 286 | * space in discovery mode. If the device has switch capabilities, then |
| 287 | * a switch is allocated and configured appropriately. Returns a pointer |
| 288 | * to a RIO device on success or NULL on failure. |
| 289 | * |
| 290 | */ |
| 291 | static struct rio_dev *rio_setup_device(struct rio_net *net, |
| 292 | struct rio_mport *port, u16 destid, |
| 293 | u8 hopcount, int do_enum) |
| 294 | { |
| 295 | struct rio_dev *rdev; |
| 296 | struct rio_switch *rswitch; |
| 297 | int result, rdid; |
| 298 | |
| 299 | rdev = kmalloc(sizeof(struct rio_dev), GFP_KERNEL); |
| 300 | if (!rdev) |
| 301 | goto out; |
| 302 | |
| 303 | memset(rdev, 0, sizeof(struct rio_dev)); |
| 304 | rdev->net = net; |
| 305 | rio_mport_read_config_32(port, destid, hopcount, RIO_DEV_ID_CAR, |
| 306 | &result); |
| 307 | rdev->did = result >> 16; |
| 308 | rdev->vid = result & 0xffff; |
| 309 | rio_mport_read_config_32(port, destid, hopcount, RIO_DEV_INFO_CAR, |
| 310 | &rdev->device_rev); |
| 311 | rio_mport_read_config_32(port, destid, hopcount, RIO_ASM_ID_CAR, |
| 312 | &result); |
| 313 | rdev->asm_did = result >> 16; |
| 314 | rdev->asm_vid = result & 0xffff; |
| 315 | rio_mport_read_config_32(port, destid, hopcount, RIO_ASM_INFO_CAR, |
| 316 | &result); |
| 317 | rdev->asm_rev = result >> 16; |
| 318 | rio_mport_read_config_32(port, destid, hopcount, RIO_PEF_CAR, |
| 319 | &rdev->pef); |
| 320 | if (rdev->pef & RIO_PEF_EXT_FEATURES) |
| 321 | rdev->efptr = result & 0xffff; |
| 322 | |
| 323 | rio_mport_read_config_32(port, destid, hopcount, RIO_SRC_OPS_CAR, |
| 324 | &rdev->src_ops); |
| 325 | rio_mport_read_config_32(port, destid, hopcount, RIO_DST_OPS_CAR, |
| 326 | &rdev->dst_ops); |
| 327 | |
| 328 | if (rio_device_has_destid(port, rdev->src_ops, rdev->dst_ops) |
| 329 | && do_enum) { |
| 330 | rio_set_device_id(port, destid, hopcount, next_destid); |
| 331 | rdev->destid = next_destid++; |
| 332 | if (next_destid == port->host_deviceid) |
| 333 | next_destid++; |
| 334 | } else |
| 335 | rdev->destid = rio_get_device_id(port, destid, hopcount); |
| 336 | |
| 337 | /* If a PE has both switch and other functions, show it as a switch */ |
| 338 | if (rio_is_switch(rdev)) { |
| 339 | rio_mport_read_config_32(port, destid, hopcount, |
| 340 | RIO_SWP_INFO_CAR, &rdev->swpinfo); |
| 341 | rswitch = kmalloc(sizeof(struct rio_switch), GFP_KERNEL); |
| 342 | if (!rswitch) { |
| 343 | kfree(rdev); |
| 344 | rdev = NULL; |
| 345 | goto out; |
| 346 | } |
| 347 | rswitch->switchid = next_switchid; |
| 348 | rswitch->hopcount = hopcount; |
| 349 | rswitch->destid = 0xffff; |
| 350 | /* Initialize switch route table */ |
| 351 | for (rdid = 0; rdid < RIO_MAX_ROUTE_ENTRIES; rdid++) |
| 352 | rswitch->route_table[rdid] = RIO_INVALID_ROUTE; |
| 353 | rdev->rswitch = rswitch; |
| 354 | sprintf(rio_name(rdev), "%02x:s:%04x", rdev->net->id, |
| 355 | rdev->rswitch->switchid); |
| 356 | rio_route_set_ops(rdev); |
| 357 | |
| 358 | list_add_tail(&rswitch->node, &rio_switches); |
| 359 | |
| 360 | } else |
| 361 | sprintf(rio_name(rdev), "%02x:e:%04x", rdev->net->id, |
| 362 | rdev->destid); |
| 363 | |
| 364 | rdev->dev.bus = &rio_bus_type; |
| 365 | |
| 366 | device_initialize(&rdev->dev); |
| 367 | rdev->dev.release = rio_release_dev; |
| 368 | rio_dev_get(rdev); |
| 369 | |
Matt Porter | fa78cc5 | 2005-11-07 01:00:18 -0800 | [diff] [blame] | 370 | rdev->dma_mask = DMA_32BIT_MASK; |
| 371 | rdev->dev.dma_mask = &rdev->dma_mask; |
| 372 | rdev->dev.coherent_dma_mask = DMA_32BIT_MASK; |
Matt Porter | eb188d0 | 2005-11-07 01:00:17 -0800 | [diff] [blame] | 373 | |
| 374 | if ((rdev->pef & RIO_PEF_INB_DOORBELL) && |
| 375 | (rdev->dst_ops & RIO_DST_OPS_DOORBELL)) |
| 376 | rio_init_dbell_res(&rdev->riores[RIO_DOORBELL_RESOURCE], |
| 377 | 0, 0xffff); |
| 378 | |
| 379 | rio_add_device(rdev); |
| 380 | |
| 381 | out: |
| 382 | return rdev; |
| 383 | } |
| 384 | |
| 385 | /** |
| 386 | * rio_sport_is_active- Tests if a switch port has an active connection. |
| 387 | * @port: Master port to send transaction |
| 388 | * @destid: Associated destination ID for switch |
| 389 | * @hopcount: Hopcount to reach switch |
| 390 | * @sport: Switch port number |
| 391 | * |
| 392 | * Reads the port error status CSR for a particular switch port to |
| 393 | * determine if the port has an active link. Returns |
| 394 | * %PORT_N_ERR_STS_PORT_OK if the port is active or %0 if it is |
| 395 | * inactive. |
| 396 | */ |
| 397 | static int |
| 398 | rio_sport_is_active(struct rio_mport *port, u16 destid, u8 hopcount, int sport) |
| 399 | { |
| 400 | u32 result; |
| 401 | u32 ext_ftr_ptr; |
| 402 | |
| 403 | int *entry = rio_sport_phys_table; |
| 404 | |
| 405 | do { |
| 406 | if ((ext_ftr_ptr = |
| 407 | rio_mport_get_feature(port, 0, destid, hopcount, *entry))) |
| 408 | |
| 409 | break; |
| 410 | } while (*++entry >= 0); |
| 411 | |
| 412 | if (ext_ftr_ptr) |
| 413 | rio_mport_read_config_32(port, destid, hopcount, |
| 414 | ext_ftr_ptr + |
| 415 | RIO_PORT_N_ERR_STS_CSR(sport), |
| 416 | &result); |
| 417 | |
| 418 | return (result & PORT_N_ERR_STS_PORT_OK); |
| 419 | } |
| 420 | |
| 421 | /** |
| 422 | * rio_route_add_entry- Add a route entry to a switch routing table |
| 423 | * @mport: Master port to send transaction |
| 424 | * @rdev: Switch device |
| 425 | * @table: Routing table ID |
| 426 | * @route_destid: Destination ID to be routed |
| 427 | * @route_port: Port number to be routed |
| 428 | * |
| 429 | * Calls the switch specific add_entry() method to add a route entry |
| 430 | * on a switch. The route table can be specified using the @table |
| 431 | * argument if a switch has per port routing tables or the normal |
| 432 | * use is to specific all tables (or the global table) by passing |
| 433 | * %RIO_GLOBAL_TABLE in @table. Returns %0 on success or %-EINVAL |
| 434 | * on failure. |
| 435 | */ |
| 436 | static int rio_route_add_entry(struct rio_mport *mport, struct rio_dev *rdev, |
| 437 | u16 table, u16 route_destid, u8 route_port) |
| 438 | { |
| 439 | return rdev->rswitch->add_entry(mport, rdev->rswitch->destid, |
| 440 | rdev->rswitch->hopcount, table, |
| 441 | route_destid, route_port); |
| 442 | } |
| 443 | |
| 444 | /** |
| 445 | * rio_route_get_entry- Read a route entry in a switch routing table |
| 446 | * @mport: Master port to send transaction |
| 447 | * @rdev: Switch device |
| 448 | * @table: Routing table ID |
| 449 | * @route_destid: Destination ID to be routed |
| 450 | * @route_port: Pointer to read port number into |
| 451 | * |
| 452 | * Calls the switch specific get_entry() method to read a route entry |
| 453 | * in a switch. The route table can be specified using the @table |
| 454 | * argument if a switch has per port routing tables or the normal |
| 455 | * use is to specific all tables (or the global table) by passing |
| 456 | * %RIO_GLOBAL_TABLE in @table. Returns %0 on success or %-EINVAL |
| 457 | * on failure. |
| 458 | */ |
| 459 | static int |
| 460 | rio_route_get_entry(struct rio_mport *mport, struct rio_dev *rdev, u16 table, |
| 461 | u16 route_destid, u8 * route_port) |
| 462 | { |
| 463 | return rdev->rswitch->get_entry(mport, rdev->rswitch->destid, |
| 464 | rdev->rswitch->hopcount, table, |
| 465 | route_destid, route_port); |
| 466 | } |
| 467 | |
| 468 | /** |
| 469 | * rio_get_host_deviceid_lock- Reads the Host Device ID Lock CSR on a device |
| 470 | * @port: Master port to send transaction |
| 471 | * @hopcount: Number of hops to the device |
| 472 | * |
| 473 | * Used during enumeration to read the Host Device ID Lock CSR on a |
| 474 | * RIO device. Returns the value of the lock register. |
| 475 | */ |
| 476 | static u16 rio_get_host_deviceid_lock(struct rio_mport *port, u8 hopcount) |
| 477 | { |
| 478 | u32 result; |
| 479 | |
| 480 | rio_mport_read_config_32(port, RIO_ANY_DESTID, hopcount, |
| 481 | RIO_HOST_DID_LOCK_CSR, &result); |
| 482 | |
| 483 | return (u16) (result & 0xffff); |
| 484 | } |
| 485 | |
| 486 | /** |
| 487 | * rio_get_swpinfo_inport- Gets the ingress port number |
| 488 | * @mport: Master port to send transaction |
| 489 | * @destid: Destination ID associated with the switch |
| 490 | * @hopcount: Number of hops to the device |
| 491 | * |
| 492 | * Returns port number being used to access the switch device. |
| 493 | */ |
| 494 | static u8 |
| 495 | rio_get_swpinfo_inport(struct rio_mport *mport, u16 destid, u8 hopcount) |
| 496 | { |
| 497 | u32 result; |
| 498 | |
| 499 | rio_mport_read_config_32(mport, destid, hopcount, RIO_SWP_INFO_CAR, |
| 500 | &result); |
| 501 | |
| 502 | return (u8) (result & 0xff); |
| 503 | } |
| 504 | |
| 505 | /** |
| 506 | * rio_get_swpinfo_tports- Gets total number of ports on the switch |
| 507 | * @mport: Master port to send transaction |
| 508 | * @destid: Destination ID associated with the switch |
| 509 | * @hopcount: Number of hops to the device |
| 510 | * |
| 511 | * Returns total numbers of ports implemented by the switch device. |
| 512 | */ |
| 513 | static u8 rio_get_swpinfo_tports(struct rio_mport *mport, u16 destid, |
| 514 | u8 hopcount) |
| 515 | { |
| 516 | u32 result; |
| 517 | |
| 518 | rio_mport_read_config_32(mport, destid, hopcount, RIO_SWP_INFO_CAR, |
| 519 | &result); |
| 520 | |
| 521 | return RIO_GET_TOTAL_PORTS(result); |
| 522 | } |
| 523 | |
| 524 | /** |
| 525 | * rio_net_add_mport- Add a master port to a RIO network |
| 526 | * @net: RIO network |
| 527 | * @port: Master port to add |
| 528 | * |
| 529 | * Adds a master port to the network list of associated master |
| 530 | * ports.. |
| 531 | */ |
| 532 | static void rio_net_add_mport(struct rio_net *net, struct rio_mport *port) |
| 533 | { |
| 534 | spin_lock(&rio_global_list_lock); |
| 535 | list_add_tail(&port->nnode, &net->mports); |
| 536 | spin_unlock(&rio_global_list_lock); |
| 537 | } |
| 538 | |
| 539 | /** |
| 540 | * rio_enum_peer- Recursively enumerate a RIO network through a master port |
| 541 | * @net: RIO network being enumerated |
| 542 | * @port: Master port to send transactions |
| 543 | * @hopcount: Number of hops into the network |
| 544 | * |
| 545 | * Recursively enumerates a RIO network. Transactions are sent via the |
| 546 | * master port passed in @port. |
| 547 | */ |
| 548 | static int rio_enum_peer(struct rio_net *net, struct rio_mport *port, |
| 549 | u8 hopcount) |
| 550 | { |
| 551 | int port_num; |
| 552 | int num_ports; |
| 553 | int cur_destid; |
| 554 | struct rio_dev *rdev; |
| 555 | u16 destid; |
| 556 | int tmp; |
| 557 | |
| 558 | if (rio_get_host_deviceid_lock(port, hopcount) == port->host_deviceid) { |
| 559 | pr_debug("RIO: PE already discovered by this host\n"); |
| 560 | /* |
| 561 | * Already discovered by this host. Add it as another |
| 562 | * master port for the current network. |
| 563 | */ |
| 564 | rio_net_add_mport(net, port); |
| 565 | return 0; |
| 566 | } |
| 567 | |
| 568 | /* Attempt to acquire device lock */ |
| 569 | rio_mport_write_config_32(port, RIO_ANY_DESTID, hopcount, |
| 570 | RIO_HOST_DID_LOCK_CSR, port->host_deviceid); |
| 571 | while ((tmp = rio_get_host_deviceid_lock(port, hopcount)) |
| 572 | < port->host_deviceid) { |
| 573 | /* Delay a bit */ |
| 574 | mdelay(1); |
| 575 | /* Attempt to acquire device lock again */ |
| 576 | rio_mport_write_config_32(port, RIO_ANY_DESTID, hopcount, |
| 577 | RIO_HOST_DID_LOCK_CSR, |
| 578 | port->host_deviceid); |
| 579 | } |
| 580 | |
| 581 | if (rio_get_host_deviceid_lock(port, hopcount) > port->host_deviceid) { |
| 582 | pr_debug( |
| 583 | "RIO: PE locked by a higher priority host...retreating\n"); |
| 584 | return -1; |
| 585 | } |
| 586 | |
| 587 | /* Setup new RIO device */ |
| 588 | if ((rdev = rio_setup_device(net, port, RIO_ANY_DESTID, hopcount, 1))) { |
| 589 | /* Add device to the global and bus/net specific list. */ |
| 590 | list_add_tail(&rdev->net_list, &net->devices); |
| 591 | } else |
| 592 | return -1; |
| 593 | |
| 594 | if (rio_is_switch(rdev)) { |
| 595 | next_switchid++; |
| 596 | |
| 597 | for (destid = 0; destid < next_destid; destid++) { |
| 598 | rio_route_add_entry(port, rdev, RIO_GLOBAL_TABLE, |
| 599 | destid, rio_get_swpinfo_inport(port, |
| 600 | RIO_ANY_DESTID, |
| 601 | hopcount)); |
| 602 | rdev->rswitch->route_table[destid] = |
| 603 | rio_get_swpinfo_inport(port, RIO_ANY_DESTID, |
| 604 | hopcount); |
| 605 | } |
| 606 | |
| 607 | num_ports = |
| 608 | rio_get_swpinfo_tports(port, RIO_ANY_DESTID, hopcount); |
| 609 | pr_debug( |
| 610 | "RIO: found %s (vid %4.4x did %4.4x) with %d ports\n", |
| 611 | rio_name(rdev), rdev->vid, rdev->did, num_ports); |
| 612 | for (port_num = 0; port_num < num_ports; port_num++) { |
| 613 | if (rio_get_swpinfo_inport |
| 614 | (port, RIO_ANY_DESTID, hopcount) == port_num) |
| 615 | continue; |
| 616 | |
| 617 | cur_destid = next_destid; |
| 618 | |
| 619 | if (rio_sport_is_active |
| 620 | (port, RIO_ANY_DESTID, hopcount, port_num)) { |
| 621 | pr_debug( |
| 622 | "RIO: scanning device on port %d\n", |
| 623 | port_num); |
| 624 | rio_route_add_entry(port, rdev, |
| 625 | RIO_GLOBAL_TABLE, |
| 626 | RIO_ANY_DESTID, port_num); |
| 627 | |
| 628 | if (rio_enum_peer(net, port, hopcount + 1) < 0) |
| 629 | return -1; |
| 630 | |
| 631 | /* Update routing tables */ |
| 632 | if (next_destid > cur_destid) { |
| 633 | for (destid = cur_destid; |
| 634 | destid < next_destid; destid++) { |
| 635 | rio_route_add_entry(port, rdev, |
| 636 | RIO_GLOBAL_TABLE, |
| 637 | destid, |
| 638 | port_num); |
| 639 | rdev->rswitch-> |
| 640 | route_table[destid] = |
| 641 | port_num; |
| 642 | } |
| 643 | rdev->rswitch->destid = cur_destid; |
| 644 | } |
| 645 | } |
| 646 | } |
| 647 | } else |
| 648 | pr_debug("RIO: found %s (vid %4.4x did %4.4x)\n", |
| 649 | rio_name(rdev), rdev->vid, rdev->did); |
| 650 | |
| 651 | return 0; |
| 652 | } |
| 653 | |
| 654 | /** |
| 655 | * rio_enum_complete- Tests if enumeration of a network is complete |
| 656 | * @port: Master port to send transaction |
| 657 | * |
| 658 | * Tests the Component Tag CSR for presence of the magic enumeration |
| 659 | * complete flag. Return %1 if enumeration is complete or %0 if |
| 660 | * enumeration is incomplete. |
| 661 | */ |
| 662 | static int rio_enum_complete(struct rio_mport *port) |
| 663 | { |
| 664 | u32 tag_csr; |
| 665 | int ret = 0; |
| 666 | |
| 667 | rio_local_read_config_32(port, RIO_COMPONENT_TAG_CSR, &tag_csr); |
| 668 | |
| 669 | if (tag_csr == RIO_ENUM_CMPL_MAGIC) |
| 670 | ret = 1; |
| 671 | |
| 672 | return ret; |
| 673 | } |
| 674 | |
| 675 | /** |
| 676 | * rio_disc_peer- Recursively discovers a RIO network through a master port |
| 677 | * @net: RIO network being discovered |
| 678 | * @port: Master port to send transactions |
| 679 | * @destid: Current destination ID in network |
| 680 | * @hopcount: Number of hops into the network |
| 681 | * |
| 682 | * Recursively discovers a RIO network. Transactions are sent via the |
| 683 | * master port passed in @port. |
| 684 | */ |
| 685 | static int |
| 686 | rio_disc_peer(struct rio_net *net, struct rio_mport *port, u16 destid, |
| 687 | u8 hopcount) |
| 688 | { |
| 689 | u8 port_num, route_port; |
| 690 | int num_ports; |
| 691 | struct rio_dev *rdev; |
| 692 | u16 ndestid; |
| 693 | |
| 694 | /* Setup new RIO device */ |
| 695 | if ((rdev = rio_setup_device(net, port, destid, hopcount, 0))) { |
| 696 | /* Add device to the global and bus/net specific list. */ |
| 697 | list_add_tail(&rdev->net_list, &net->devices); |
| 698 | } else |
| 699 | return -1; |
| 700 | |
| 701 | if (rio_is_switch(rdev)) { |
| 702 | next_switchid++; |
| 703 | |
| 704 | /* Associated destid is how we accessed this switch */ |
| 705 | rdev->rswitch->destid = destid; |
| 706 | |
| 707 | num_ports = rio_get_swpinfo_tports(port, destid, hopcount); |
| 708 | pr_debug( |
| 709 | "RIO: found %s (vid %4.4x did %4.4x) with %d ports\n", |
| 710 | rio_name(rdev), rdev->vid, rdev->did, num_ports); |
| 711 | for (port_num = 0; port_num < num_ports; port_num++) { |
| 712 | if (rio_get_swpinfo_inport(port, destid, hopcount) == |
| 713 | port_num) |
| 714 | continue; |
| 715 | |
| 716 | if (rio_sport_is_active |
| 717 | (port, destid, hopcount, port_num)) { |
| 718 | pr_debug( |
| 719 | "RIO: scanning device on port %d\n", |
| 720 | port_num); |
| 721 | for (ndestid = 0; ndestid < RIO_ANY_DESTID; |
| 722 | ndestid++) { |
| 723 | rio_route_get_entry(port, rdev, |
| 724 | RIO_GLOBAL_TABLE, |
| 725 | ndestid, |
| 726 | &route_port); |
| 727 | if (route_port == port_num) |
| 728 | break; |
| 729 | } |
| 730 | |
| 731 | if (rio_disc_peer |
| 732 | (net, port, ndestid, hopcount + 1) < 0) |
| 733 | return -1; |
| 734 | } |
| 735 | } |
| 736 | } else |
| 737 | pr_debug("RIO: found %s (vid %4.4x did %4.4x)\n", |
| 738 | rio_name(rdev), rdev->vid, rdev->did); |
| 739 | |
| 740 | return 0; |
| 741 | } |
| 742 | |
| 743 | /** |
| 744 | * rio_mport_is_active- Tests if master port link is active |
| 745 | * @port: Master port to test |
| 746 | * |
| 747 | * Reads the port error status CSR for the master port to |
| 748 | * determine if the port has an active link. Returns |
| 749 | * %PORT_N_ERR_STS_PORT_OK if the master port is active |
| 750 | * or %0 if it is inactive. |
| 751 | */ |
| 752 | static int rio_mport_is_active(struct rio_mport *port) |
| 753 | { |
| 754 | u32 result = 0; |
| 755 | u32 ext_ftr_ptr; |
| 756 | int *entry = rio_mport_phys_table; |
| 757 | |
| 758 | do { |
| 759 | if ((ext_ftr_ptr = |
| 760 | rio_mport_get_feature(port, 1, 0, 0, *entry))) |
| 761 | break; |
| 762 | } while (*++entry >= 0); |
| 763 | |
| 764 | if (ext_ftr_ptr) |
| 765 | rio_local_read_config_32(port, |
| 766 | ext_ftr_ptr + |
| 767 | RIO_PORT_N_ERR_STS_CSR(port->index), |
| 768 | &result); |
| 769 | |
| 770 | return (result & PORT_N_ERR_STS_PORT_OK); |
| 771 | } |
| 772 | |
| 773 | /** |
| 774 | * rio_alloc_net- Allocate and configure a new RIO network |
| 775 | * @port: Master port associated with the RIO network |
| 776 | * |
| 777 | * Allocates a RIO network structure, initializes per-network |
| 778 | * list heads, and adds the associated master port to the |
| 779 | * network list of associated master ports. Returns a |
| 780 | * RIO network pointer on success or %NULL on failure. |
| 781 | */ |
| 782 | static struct rio_net __devinit *rio_alloc_net(struct rio_mport *port) |
| 783 | { |
| 784 | struct rio_net *net; |
| 785 | |
| 786 | net = kmalloc(sizeof(struct rio_net), GFP_KERNEL); |
| 787 | if (net) { |
| 788 | memset(net, 0, sizeof(struct rio_net)); |
| 789 | INIT_LIST_HEAD(&net->node); |
| 790 | INIT_LIST_HEAD(&net->devices); |
| 791 | INIT_LIST_HEAD(&net->mports); |
| 792 | list_add_tail(&port->nnode, &net->mports); |
| 793 | net->hport = port; |
| 794 | net->id = next_net++; |
| 795 | } |
| 796 | return net; |
| 797 | } |
| 798 | |
| 799 | /** |
| 800 | * rio_enum_mport- Start enumeration through a master port |
| 801 | * @mport: Master port to send transactions |
| 802 | * |
| 803 | * Starts the enumeration process. If somebody has enumerated our |
| 804 | * master port device, then give up. If not and we have an active |
| 805 | * link, then start recursive peer enumeration. Returns %0 if |
| 806 | * enumeration succeeds or %-EBUSY if enumeration fails. |
| 807 | */ |
| 808 | int rio_enum_mport(struct rio_mport *mport) |
| 809 | { |
| 810 | struct rio_net *net = NULL; |
| 811 | int rc = 0; |
| 812 | |
| 813 | printk(KERN_INFO "RIO: enumerate master port %d, %s\n", mport->id, |
| 814 | mport->name); |
| 815 | /* If somebody else enumerated our master port device, bail. */ |
| 816 | if (rio_enum_host(mport) < 0) { |
| 817 | printk(KERN_INFO |
| 818 | "RIO: master port %d device has been enumerated by a remote host\n", |
| 819 | mport->id); |
| 820 | rc = -EBUSY; |
| 821 | goto out; |
| 822 | } |
| 823 | |
| 824 | /* If master port has an active link, allocate net and enum peers */ |
| 825 | if (rio_mport_is_active(mport)) { |
| 826 | if (!(net = rio_alloc_net(mport))) { |
| 827 | printk(KERN_ERR "RIO: failed to allocate new net\n"); |
| 828 | rc = -ENOMEM; |
| 829 | goto out; |
| 830 | } |
| 831 | if (rio_enum_peer(net, mport, 0) < 0) { |
| 832 | /* A higher priority host won enumeration, bail. */ |
| 833 | printk(KERN_INFO |
| 834 | "RIO: master port %d device has lost enumeration to a remote host\n", |
| 835 | mport->id); |
| 836 | rio_clear_locks(mport); |
| 837 | rc = -EBUSY; |
| 838 | goto out; |
| 839 | } |
| 840 | rio_clear_locks(mport); |
| 841 | } else { |
| 842 | printk(KERN_INFO "RIO: master port %d link inactive\n", |
| 843 | mport->id); |
| 844 | rc = -EINVAL; |
| 845 | } |
| 846 | |
| 847 | out: |
| 848 | return rc; |
| 849 | } |
| 850 | |
| 851 | /** |
| 852 | * rio_build_route_tables- Generate route tables from switch route entries |
| 853 | * |
| 854 | * For each switch device, generate a route table by copying existing |
| 855 | * route entries from the switch. |
| 856 | */ |
| 857 | static void rio_build_route_tables(void) |
| 858 | { |
| 859 | struct rio_dev *rdev; |
| 860 | int i; |
| 861 | u8 sport; |
| 862 | |
| 863 | list_for_each_entry(rdev, &rio_devices, global_list) |
| 864 | if (rio_is_switch(rdev)) |
| 865 | for (i = 0; i < RIO_MAX_ROUTE_ENTRIES; i++) { |
| 866 | if (rio_route_get_entry |
| 867 | (rdev->net->hport, rdev, RIO_GLOBAL_TABLE, i, |
| 868 | &sport) < 0) |
| 869 | continue; |
| 870 | rdev->rswitch->route_table[i] = sport; |
| 871 | } |
| 872 | } |
| 873 | |
| 874 | /** |
| 875 | * rio_enum_timeout- Signal that enumeration timed out |
| 876 | * @data: Address of timeout flag. |
| 877 | * |
| 878 | * When the enumeration complete timer expires, set a flag that |
| 879 | * signals to the discovery process that enumeration did not |
| 880 | * complete in a sane amount of time. |
| 881 | */ |
| 882 | static void rio_enum_timeout(unsigned long data) |
| 883 | { |
| 884 | /* Enumeration timed out, set flag */ |
| 885 | *(int *)data = 1; |
| 886 | } |
| 887 | |
| 888 | /** |
| 889 | * rio_disc_mport- Start discovery through a master port |
| 890 | * @mport: Master port to send transactions |
| 891 | * |
| 892 | * Starts the discovery process. If we have an active link, |
| 893 | * then wait for the signal that enumeration is complete. |
| 894 | * When enumeration completion is signaled, start recursive |
| 895 | * peer discovery. Returns %0 if discovery succeeds or %-EBUSY |
| 896 | * on failure. |
| 897 | */ |
| 898 | int rio_disc_mport(struct rio_mport *mport) |
| 899 | { |
| 900 | struct rio_net *net = NULL; |
| 901 | int enum_timeout_flag = 0; |
| 902 | |
| 903 | printk(KERN_INFO "RIO: discover master port %d, %s\n", mport->id, |
| 904 | mport->name); |
| 905 | |
| 906 | /* If master port has an active link, allocate net and discover peers */ |
| 907 | if (rio_mport_is_active(mport)) { |
| 908 | if (!(net = rio_alloc_net(mport))) { |
| 909 | printk(KERN_ERR "RIO: Failed to allocate new net\n"); |
| 910 | goto bail; |
| 911 | } |
| 912 | |
| 913 | pr_debug("RIO: wait for enumeration complete..."); |
| 914 | |
| 915 | rio_enum_timer.expires = |
| 916 | jiffies + CONFIG_RAPIDIO_DISC_TIMEOUT * HZ; |
| 917 | rio_enum_timer.data = (unsigned long)&enum_timeout_flag; |
| 918 | add_timer(&rio_enum_timer); |
| 919 | while (!rio_enum_complete(mport)) { |
| 920 | mdelay(1); |
| 921 | if (enum_timeout_flag) { |
| 922 | del_timer_sync(&rio_enum_timer); |
| 923 | goto timeout; |
| 924 | } |
| 925 | } |
| 926 | del_timer_sync(&rio_enum_timer); |
| 927 | |
| 928 | pr_debug("done\n"); |
| 929 | if (rio_disc_peer(net, mport, RIO_ANY_DESTID, 0) < 0) { |
| 930 | printk(KERN_INFO |
| 931 | "RIO: master port %d device has failed discovery\n", |
| 932 | mport->id); |
| 933 | goto bail; |
| 934 | } |
| 935 | |
| 936 | rio_build_route_tables(); |
| 937 | } |
| 938 | |
| 939 | return 0; |
| 940 | |
| 941 | timeout: |
| 942 | pr_debug("timeout\n"); |
| 943 | bail: |
| 944 | return -EBUSY; |
| 945 | } |