| 1 | /* |
| 2 | * Broadcom specific AMBA |
| 3 | * Bus subsystem |
| 4 | * |
| 5 | * Licensed under the GNU/GPL. See COPYING for details. |
| 6 | */ |
| 7 | |
| 8 | #include "bcma_private.h" |
| 9 | #include <linux/module.h> |
| 10 | #include <linux/mmc/sdio_func.h> |
| 11 | #include <linux/platform_device.h> |
| 12 | #include <linux/pci.h> |
| 13 | #include <linux/bcma/bcma.h> |
| 14 | #include <linux/slab.h> |
| 15 | #include <linux/of_address.h> |
| 16 | #include <linux/of_irq.h> |
| 17 | #include <linux/of_device.h> |
| 18 | #include <linux/of_platform.h> |
| 19 | |
| 20 | MODULE_DESCRIPTION("Broadcom's specific AMBA driver"); |
| 21 | MODULE_LICENSE("GPL"); |
| 22 | |
| 23 | /* contains the number the next bus should get. */ |
| 24 | static unsigned int bcma_bus_next_num; |
| 25 | |
| 26 | /* bcma_buses_mutex locks the bcma_bus_next_num */ |
| 27 | static DEFINE_MUTEX(bcma_buses_mutex); |
| 28 | |
| 29 | static int bcma_bus_match(struct device *dev, const struct device_driver *drv); |
| 30 | static int bcma_device_probe(struct device *dev); |
| 31 | static void bcma_device_remove(struct device *dev); |
| 32 | static int bcma_device_uevent(const struct device *dev, struct kobj_uevent_env *env); |
| 33 | |
| 34 | static ssize_t manuf_show(struct device *dev, struct device_attribute *attr, char *buf) |
| 35 | { |
| 36 | struct bcma_device *core = container_of(dev, struct bcma_device, dev); |
| 37 | return sprintf(buf, "0x%03X\n", core->id.manuf); |
| 38 | } |
| 39 | static DEVICE_ATTR_RO(manuf); |
| 40 | |
| 41 | static ssize_t id_show(struct device *dev, struct device_attribute *attr, char *buf) |
| 42 | { |
| 43 | struct bcma_device *core = container_of(dev, struct bcma_device, dev); |
| 44 | return sprintf(buf, "0x%03X\n", core->id.id); |
| 45 | } |
| 46 | static DEVICE_ATTR_RO(id); |
| 47 | |
| 48 | static ssize_t rev_show(struct device *dev, struct device_attribute *attr, char *buf) |
| 49 | { |
| 50 | struct bcma_device *core = container_of(dev, struct bcma_device, dev); |
| 51 | return sprintf(buf, "0x%02X\n", core->id.rev); |
| 52 | } |
| 53 | static DEVICE_ATTR_RO(rev); |
| 54 | |
| 55 | static ssize_t class_show(struct device *dev, struct device_attribute *attr, char *buf) |
| 56 | { |
| 57 | struct bcma_device *core = container_of(dev, struct bcma_device, dev); |
| 58 | return sprintf(buf, "0x%X\n", core->id.class); |
| 59 | } |
| 60 | static DEVICE_ATTR_RO(class); |
| 61 | |
| 62 | static struct attribute *bcma_device_attrs[] = { |
| 63 | &dev_attr_manuf.attr, |
| 64 | &dev_attr_id.attr, |
| 65 | &dev_attr_rev.attr, |
| 66 | &dev_attr_class.attr, |
| 67 | NULL, |
| 68 | }; |
| 69 | ATTRIBUTE_GROUPS(bcma_device); |
| 70 | |
| 71 | static const struct bus_type bcma_bus_type = { |
| 72 | .name = "bcma", |
| 73 | .match = bcma_bus_match, |
| 74 | .probe = bcma_device_probe, |
| 75 | .remove = bcma_device_remove, |
| 76 | .uevent = bcma_device_uevent, |
| 77 | .dev_groups = bcma_device_groups, |
| 78 | }; |
| 79 | |
| 80 | static u16 bcma_cc_core_id(struct bcma_bus *bus) |
| 81 | { |
| 82 | if (bus->chipinfo.id == BCMA_CHIP_ID_BCM4706) |
| 83 | return BCMA_CORE_4706_CHIPCOMMON; |
| 84 | return BCMA_CORE_CHIPCOMMON; |
| 85 | } |
| 86 | |
| 87 | struct bcma_device *bcma_find_core_unit(struct bcma_bus *bus, u16 coreid, |
| 88 | u8 unit) |
| 89 | { |
| 90 | struct bcma_device *core; |
| 91 | |
| 92 | list_for_each_entry(core, &bus->cores, list) { |
| 93 | if (core->id.id == coreid && core->core_unit == unit) |
| 94 | return core; |
| 95 | } |
| 96 | return NULL; |
| 97 | } |
| 98 | EXPORT_SYMBOL_GPL(bcma_find_core_unit); |
| 99 | |
| 100 | bool bcma_wait_value(struct bcma_device *core, u16 reg, u32 mask, u32 value, |
| 101 | int timeout) |
| 102 | { |
| 103 | unsigned long deadline = jiffies + timeout; |
| 104 | u32 val; |
| 105 | |
| 106 | do { |
| 107 | val = bcma_read32(core, reg); |
| 108 | if ((val & mask) == value) |
| 109 | return true; |
| 110 | cpu_relax(); |
| 111 | udelay(10); |
| 112 | } while (!time_after_eq(jiffies, deadline)); |
| 113 | |
| 114 | bcma_warn(core->bus, "Timeout waiting for register 0x%04X!\n", reg); |
| 115 | |
| 116 | return false; |
| 117 | } |
| 118 | |
| 119 | static void bcma_release_core_dev(struct device *dev) |
| 120 | { |
| 121 | struct bcma_device *core = container_of(dev, struct bcma_device, dev); |
| 122 | if (core->io_addr) |
| 123 | iounmap(core->io_addr); |
| 124 | if (core->io_wrap) |
| 125 | iounmap(core->io_wrap); |
| 126 | kfree(core); |
| 127 | } |
| 128 | |
| 129 | static bool bcma_is_core_needed_early(u16 core_id) |
| 130 | { |
| 131 | switch (core_id) { |
| 132 | case BCMA_CORE_NS_NAND: |
| 133 | case BCMA_CORE_NS_QSPI: |
| 134 | return true; |
| 135 | } |
| 136 | |
| 137 | return false; |
| 138 | } |
| 139 | |
| 140 | static struct device_node *bcma_of_find_child_device(struct device *parent, |
| 141 | struct bcma_device *core) |
| 142 | { |
| 143 | struct device_node *node; |
| 144 | int ret; |
| 145 | |
| 146 | if (!parent->of_node) |
| 147 | return NULL; |
| 148 | |
| 149 | for_each_child_of_node(parent->of_node, node) { |
| 150 | struct resource res; |
| 151 | ret = of_address_to_resource(node, 0, &res); |
| 152 | if (ret) |
| 153 | continue; |
| 154 | if (res.start == core->addr) |
| 155 | return node; |
| 156 | } |
| 157 | return NULL; |
| 158 | } |
| 159 | |
| 160 | static int bcma_of_irq_parse(struct device *parent, |
| 161 | struct bcma_device *core, |
| 162 | struct of_phandle_args *out_irq, int num) |
| 163 | { |
| 164 | __be32 laddr[1]; |
| 165 | int rc; |
| 166 | |
| 167 | if (core->dev.of_node) { |
| 168 | rc = of_irq_parse_one(core->dev.of_node, num, out_irq); |
| 169 | if (!rc) |
| 170 | return rc; |
| 171 | } |
| 172 | |
| 173 | out_irq->np = parent->of_node; |
| 174 | out_irq->args_count = 1; |
| 175 | out_irq->args[0] = num; |
| 176 | |
| 177 | laddr[0] = cpu_to_be32(core->addr); |
| 178 | return of_irq_parse_raw(laddr, out_irq); |
| 179 | } |
| 180 | |
| 181 | static unsigned int bcma_of_get_irq(struct device *parent, |
| 182 | struct bcma_device *core, int num) |
| 183 | { |
| 184 | struct of_phandle_args out_irq; |
| 185 | int ret; |
| 186 | |
| 187 | if (!IS_ENABLED(CONFIG_OF_IRQ) || !parent->of_node) |
| 188 | return 0; |
| 189 | |
| 190 | ret = bcma_of_irq_parse(parent, core, &out_irq, num); |
| 191 | if (ret) { |
| 192 | bcma_debug(core->bus, "bcma_of_get_irq() failed with rc=%d\n", |
| 193 | ret); |
| 194 | return 0; |
| 195 | } |
| 196 | |
| 197 | return irq_create_of_mapping(&out_irq); |
| 198 | } |
| 199 | |
| 200 | static void bcma_of_fill_device(struct device *parent, |
| 201 | struct bcma_device *core) |
| 202 | { |
| 203 | struct device_node *node; |
| 204 | |
| 205 | node = bcma_of_find_child_device(parent, core); |
| 206 | if (node) |
| 207 | core->dev.of_node = node; |
| 208 | |
| 209 | core->irq = bcma_of_get_irq(parent, core, 0); |
| 210 | |
| 211 | of_dma_configure(&core->dev, node, false); |
| 212 | } |
| 213 | |
| 214 | unsigned int bcma_core_irq(struct bcma_device *core, int num) |
| 215 | { |
| 216 | struct bcma_bus *bus = core->bus; |
| 217 | unsigned int mips_irq; |
| 218 | |
| 219 | switch (bus->hosttype) { |
| 220 | case BCMA_HOSTTYPE_PCI: |
| 221 | return bus->host_pci->irq; |
| 222 | case BCMA_HOSTTYPE_SOC: |
| 223 | if (bus->drv_mips.core && num == 0) { |
| 224 | mips_irq = bcma_core_mips_irq(core); |
| 225 | return mips_irq <= 4 ? mips_irq + 2 : 0; |
| 226 | } |
| 227 | if (bus->dev) |
| 228 | return bcma_of_get_irq(bus->dev, core, num); |
| 229 | return 0; |
| 230 | case BCMA_HOSTTYPE_SDIO: |
| 231 | return 0; |
| 232 | } |
| 233 | |
| 234 | return 0; |
| 235 | } |
| 236 | EXPORT_SYMBOL(bcma_core_irq); |
| 237 | |
| 238 | void bcma_prepare_core(struct bcma_bus *bus, struct bcma_device *core) |
| 239 | { |
| 240 | device_initialize(&core->dev); |
| 241 | core->dev.release = bcma_release_core_dev; |
| 242 | core->dev.bus = &bcma_bus_type; |
| 243 | dev_set_name(&core->dev, "bcma%d:%d", bus->num, core->core_index); |
| 244 | core->dev.parent = bus->dev; |
| 245 | if (bus->dev) |
| 246 | bcma_of_fill_device(bus->dev, core); |
| 247 | |
| 248 | switch (bus->hosttype) { |
| 249 | case BCMA_HOSTTYPE_PCI: |
| 250 | core->dma_dev = bus->dev; |
| 251 | core->irq = bus->host_pci->irq; |
| 252 | break; |
| 253 | case BCMA_HOSTTYPE_SOC: |
| 254 | if (IS_ENABLED(CONFIG_OF) && bus->dev) { |
| 255 | core->dma_dev = bus->dev; |
| 256 | } else { |
| 257 | core->dev.dma_mask = &core->dev.coherent_dma_mask; |
| 258 | core->dma_dev = &core->dev; |
| 259 | } |
| 260 | break; |
| 261 | case BCMA_HOSTTYPE_SDIO: |
| 262 | break; |
| 263 | } |
| 264 | } |
| 265 | |
| 266 | void bcma_init_bus(struct bcma_bus *bus) |
| 267 | { |
| 268 | mutex_lock(&bcma_buses_mutex); |
| 269 | bus->num = bcma_bus_next_num++; |
| 270 | mutex_unlock(&bcma_buses_mutex); |
| 271 | |
| 272 | INIT_LIST_HEAD(&bus->cores); |
| 273 | bus->nr_cores = 0; |
| 274 | |
| 275 | bcma_detect_chip(bus); |
| 276 | } |
| 277 | |
| 278 | static void bcma_register_core(struct bcma_bus *bus, struct bcma_device *core) |
| 279 | { |
| 280 | int err; |
| 281 | |
| 282 | err = device_add(&core->dev); |
| 283 | if (err) { |
| 284 | bcma_err(bus, "Could not register dev for core 0x%03X\n", |
| 285 | core->id.id); |
| 286 | return; |
| 287 | } |
| 288 | core->dev_registered = true; |
| 289 | } |
| 290 | |
| 291 | static int bcma_register_devices(struct bcma_bus *bus) |
| 292 | { |
| 293 | struct bcma_device *core; |
| 294 | int err; |
| 295 | |
| 296 | list_for_each_entry(core, &bus->cores, list) { |
| 297 | /* We support that core ourselves */ |
| 298 | switch (core->id.id) { |
| 299 | case BCMA_CORE_4706_CHIPCOMMON: |
| 300 | case BCMA_CORE_CHIPCOMMON: |
| 301 | case BCMA_CORE_NS_CHIPCOMMON_B: |
| 302 | case BCMA_CORE_PCI: |
| 303 | case BCMA_CORE_PCIE: |
| 304 | case BCMA_CORE_PCIE2: |
| 305 | case BCMA_CORE_MIPS_74K: |
| 306 | case BCMA_CORE_4706_MAC_GBIT_COMMON: |
| 307 | continue; |
| 308 | } |
| 309 | |
| 310 | /* Early cores were already registered */ |
| 311 | if (bcma_is_core_needed_early(core->id.id)) |
| 312 | continue; |
| 313 | |
| 314 | /* Only first GMAC core on BCM4706 is connected and working */ |
| 315 | if (core->id.id == BCMA_CORE_4706_MAC_GBIT && |
| 316 | core->core_unit > 0) |
| 317 | continue; |
| 318 | |
| 319 | bcma_register_core(bus, core); |
| 320 | } |
| 321 | |
| 322 | #ifdef CONFIG_BCMA_PFLASH |
| 323 | if (bus->drv_cc.pflash.present) { |
| 324 | err = platform_device_register(&bcma_pflash_dev); |
| 325 | if (err) |
| 326 | bcma_err(bus, "Error registering parallel flash\n"); |
| 327 | } |
| 328 | #endif |
| 329 | |
| 330 | #ifdef CONFIG_BCMA_SFLASH |
| 331 | if (bus->drv_cc.sflash.present) { |
| 332 | err = platform_device_register(&bcma_sflash_dev); |
| 333 | if (err) |
| 334 | bcma_err(bus, "Error registering serial flash\n"); |
| 335 | } |
| 336 | #endif |
| 337 | |
| 338 | #ifdef CONFIG_BCMA_NFLASH |
| 339 | if (bus->drv_cc.nflash.present) { |
| 340 | err = platform_device_register(&bcma_nflash_dev); |
| 341 | if (err) |
| 342 | bcma_err(bus, "Error registering NAND flash\n"); |
| 343 | } |
| 344 | #endif |
| 345 | err = bcma_gpio_init(&bus->drv_cc); |
| 346 | if (err == -ENOTSUPP) |
| 347 | bcma_debug(bus, "GPIO driver not activated\n"); |
| 348 | else if (err) { |
| 349 | bcma_err(bus, "Error registering GPIO driver: %i\n", err); |
| 350 | return err; |
| 351 | } |
| 352 | |
| 353 | if (bus->hosttype == BCMA_HOSTTYPE_SOC) { |
| 354 | err = bcma_chipco_watchdog_register(&bus->drv_cc); |
| 355 | if (err) |
| 356 | bcma_err(bus, "Error registering watchdog driver\n"); |
| 357 | } |
| 358 | |
| 359 | return 0; |
| 360 | } |
| 361 | |
| 362 | void bcma_unregister_cores(struct bcma_bus *bus) |
| 363 | { |
| 364 | struct bcma_device *core, *tmp; |
| 365 | |
| 366 | list_for_each_entry_safe(core, tmp, &bus->cores, list) { |
| 367 | if (!core->dev_registered) |
| 368 | continue; |
| 369 | list_del(&core->list); |
| 370 | device_unregister(&core->dev); |
| 371 | } |
| 372 | if (bus->hosttype == BCMA_HOSTTYPE_SOC) |
| 373 | platform_device_unregister(bus->drv_cc.watchdog); |
| 374 | |
| 375 | /* Now no one uses internally-handled cores, we can free them */ |
| 376 | list_for_each_entry_safe(core, tmp, &bus->cores, list) { |
| 377 | list_del(&core->list); |
| 378 | put_device(&core->dev); |
| 379 | } |
| 380 | } |
| 381 | |
| 382 | int bcma_bus_register(struct bcma_bus *bus) |
| 383 | { |
| 384 | int err; |
| 385 | struct bcma_device *core; |
| 386 | |
| 387 | /* Scan for devices (cores) */ |
| 388 | err = bcma_bus_scan(bus); |
| 389 | if (err) { |
| 390 | bcma_err(bus, "Failed to scan: %d\n", err); |
| 391 | return err; |
| 392 | } |
| 393 | |
| 394 | /* Early init CC core */ |
| 395 | core = bcma_find_core(bus, bcma_cc_core_id(bus)); |
| 396 | if (core) { |
| 397 | bus->drv_cc.core = core; |
| 398 | bcma_core_chipcommon_early_init(&bus->drv_cc); |
| 399 | } |
| 400 | |
| 401 | /* Early init PCIE core */ |
| 402 | core = bcma_find_core(bus, BCMA_CORE_PCIE); |
| 403 | if (core) { |
| 404 | bus->drv_pci[0].core = core; |
| 405 | bcma_core_pci_early_init(&bus->drv_pci[0]); |
| 406 | } |
| 407 | |
| 408 | if (bus->dev) |
| 409 | of_platform_default_populate(bus->dev->of_node, NULL, bus->dev); |
| 410 | |
| 411 | /* Cores providing flash access go before SPROM init */ |
| 412 | list_for_each_entry(core, &bus->cores, list) { |
| 413 | if (bcma_is_core_needed_early(core->id.id)) |
| 414 | bcma_register_core(bus, core); |
| 415 | } |
| 416 | |
| 417 | /* Try to get SPROM */ |
| 418 | err = bcma_sprom_get(bus); |
| 419 | if (err == -ENOENT) { |
| 420 | bcma_err(bus, "No SPROM available\n"); |
| 421 | } else if (err) |
| 422 | bcma_err(bus, "Failed to get SPROM: %d\n", err); |
| 423 | |
| 424 | /* Init CC core */ |
| 425 | core = bcma_find_core(bus, bcma_cc_core_id(bus)); |
| 426 | if (core) { |
| 427 | bus->drv_cc.core = core; |
| 428 | bcma_core_chipcommon_init(&bus->drv_cc); |
| 429 | } |
| 430 | |
| 431 | /* Init CC core */ |
| 432 | core = bcma_find_core(bus, BCMA_CORE_NS_CHIPCOMMON_B); |
| 433 | if (core) { |
| 434 | bus->drv_cc_b.core = core; |
| 435 | bcma_core_chipcommon_b_init(&bus->drv_cc_b); |
| 436 | } |
| 437 | |
| 438 | /* Init MIPS core */ |
| 439 | core = bcma_find_core(bus, BCMA_CORE_MIPS_74K); |
| 440 | if (core) { |
| 441 | bus->drv_mips.core = core; |
| 442 | bcma_core_mips_init(&bus->drv_mips); |
| 443 | } |
| 444 | |
| 445 | /* Init PCIE core */ |
| 446 | core = bcma_find_core_unit(bus, BCMA_CORE_PCIE, 0); |
| 447 | if (core) { |
| 448 | bus->drv_pci[0].core = core; |
| 449 | bcma_core_pci_init(&bus->drv_pci[0]); |
| 450 | } |
| 451 | |
| 452 | /* Init PCIE core */ |
| 453 | core = bcma_find_core_unit(bus, BCMA_CORE_PCIE, 1); |
| 454 | if (core) { |
| 455 | bus->drv_pci[1].core = core; |
| 456 | bcma_core_pci_init(&bus->drv_pci[1]); |
| 457 | } |
| 458 | |
| 459 | /* Init PCIe Gen 2 core */ |
| 460 | core = bcma_find_core_unit(bus, BCMA_CORE_PCIE2, 0); |
| 461 | if (core) { |
| 462 | bus->drv_pcie2.core = core; |
| 463 | bcma_core_pcie2_init(&bus->drv_pcie2); |
| 464 | } |
| 465 | |
| 466 | /* Init GBIT MAC COMMON core */ |
| 467 | core = bcma_find_core(bus, BCMA_CORE_4706_MAC_GBIT_COMMON); |
| 468 | if (core) { |
| 469 | bus->drv_gmac_cmn.core = core; |
| 470 | bcma_core_gmac_cmn_init(&bus->drv_gmac_cmn); |
| 471 | } |
| 472 | |
| 473 | /* Register found cores */ |
| 474 | bcma_register_devices(bus); |
| 475 | |
| 476 | bcma_info(bus, "Bus registered\n"); |
| 477 | |
| 478 | return 0; |
| 479 | } |
| 480 | |
| 481 | void bcma_bus_unregister(struct bcma_bus *bus) |
| 482 | { |
| 483 | int err; |
| 484 | |
| 485 | err = bcma_gpio_unregister(&bus->drv_cc); |
| 486 | if (err == -EBUSY) |
| 487 | bcma_err(bus, "Some GPIOs are still in use.\n"); |
| 488 | else if (err) |
| 489 | bcma_err(bus, "Can not unregister GPIO driver: %i\n", err); |
| 490 | |
| 491 | bcma_core_chipcommon_b_free(&bus->drv_cc_b); |
| 492 | |
| 493 | bcma_unregister_cores(bus); |
| 494 | } |
| 495 | |
| 496 | /* |
| 497 | * This is a special version of bus registration function designed for SoCs. |
| 498 | * It scans bus and performs basic initialization of main cores only. |
| 499 | * Please note it requires memory allocation, however it won't try to sleep. |
| 500 | */ |
| 501 | int __init bcma_bus_early_register(struct bcma_bus *bus) |
| 502 | { |
| 503 | int err; |
| 504 | struct bcma_device *core; |
| 505 | |
| 506 | /* Scan for devices (cores) */ |
| 507 | err = bcma_bus_scan(bus); |
| 508 | if (err) { |
| 509 | bcma_err(bus, "Failed to scan bus: %d\n", err); |
| 510 | return -1; |
| 511 | } |
| 512 | |
| 513 | /* Early init CC core */ |
| 514 | core = bcma_find_core(bus, bcma_cc_core_id(bus)); |
| 515 | if (core) { |
| 516 | bus->drv_cc.core = core; |
| 517 | bcma_core_chipcommon_early_init(&bus->drv_cc); |
| 518 | } |
| 519 | |
| 520 | /* Early init MIPS core */ |
| 521 | core = bcma_find_core(bus, BCMA_CORE_MIPS_74K); |
| 522 | if (core) { |
| 523 | bus->drv_mips.core = core; |
| 524 | bcma_core_mips_early_init(&bus->drv_mips); |
| 525 | } |
| 526 | |
| 527 | bcma_info(bus, "Early bus registered\n"); |
| 528 | |
| 529 | return 0; |
| 530 | } |
| 531 | |
| 532 | #ifdef CONFIG_PM |
| 533 | int bcma_bus_suspend(struct bcma_bus *bus) |
| 534 | { |
| 535 | struct bcma_device *core; |
| 536 | |
| 537 | list_for_each_entry(core, &bus->cores, list) { |
| 538 | struct device_driver *drv = core->dev.driver; |
| 539 | if (drv) { |
| 540 | struct bcma_driver *adrv = container_of(drv, struct bcma_driver, drv); |
| 541 | if (adrv->suspend) |
| 542 | adrv->suspend(core); |
| 543 | } |
| 544 | } |
| 545 | return 0; |
| 546 | } |
| 547 | |
| 548 | int bcma_bus_resume(struct bcma_bus *bus) |
| 549 | { |
| 550 | struct bcma_device *core; |
| 551 | |
| 552 | /* Init CC core */ |
| 553 | if (bus->drv_cc.core) { |
| 554 | bus->drv_cc.setup_done = false; |
| 555 | bcma_core_chipcommon_init(&bus->drv_cc); |
| 556 | } |
| 557 | |
| 558 | list_for_each_entry(core, &bus->cores, list) { |
| 559 | struct device_driver *drv = core->dev.driver; |
| 560 | if (drv) { |
| 561 | struct bcma_driver *adrv = container_of(drv, struct bcma_driver, drv); |
| 562 | if (adrv->resume) |
| 563 | adrv->resume(core); |
| 564 | } |
| 565 | } |
| 566 | |
| 567 | return 0; |
| 568 | } |
| 569 | #endif |
| 570 | |
| 571 | int __bcma_driver_register(struct bcma_driver *drv, struct module *owner) |
| 572 | { |
| 573 | drv->drv.name = drv->name; |
| 574 | drv->drv.bus = &bcma_bus_type; |
| 575 | drv->drv.owner = owner; |
| 576 | |
| 577 | return driver_register(&drv->drv); |
| 578 | } |
| 579 | EXPORT_SYMBOL_GPL(__bcma_driver_register); |
| 580 | |
| 581 | void bcma_driver_unregister(struct bcma_driver *drv) |
| 582 | { |
| 583 | driver_unregister(&drv->drv); |
| 584 | } |
| 585 | EXPORT_SYMBOL_GPL(bcma_driver_unregister); |
| 586 | |
| 587 | static int bcma_bus_match(struct device *dev, const struct device_driver *drv) |
| 588 | { |
| 589 | struct bcma_device *core = container_of(dev, struct bcma_device, dev); |
| 590 | const struct bcma_driver *adrv = container_of_const(drv, struct bcma_driver, drv); |
| 591 | const struct bcma_device_id *cid = &core->id; |
| 592 | const struct bcma_device_id *did; |
| 593 | |
| 594 | for (did = adrv->id_table; did->manuf || did->id || did->rev; did++) { |
| 595 | if ((did->manuf == cid->manuf || did->manuf == BCMA_ANY_MANUF) && |
| 596 | (did->id == cid->id || did->id == BCMA_ANY_ID) && |
| 597 | (did->rev == cid->rev || did->rev == BCMA_ANY_REV) && |
| 598 | (did->class == cid->class || did->class == BCMA_ANY_CLASS)) |
| 599 | return 1; |
| 600 | } |
| 601 | return 0; |
| 602 | } |
| 603 | |
| 604 | static int bcma_device_probe(struct device *dev) |
| 605 | { |
| 606 | struct bcma_device *core = container_of(dev, struct bcma_device, dev); |
| 607 | struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver, |
| 608 | drv); |
| 609 | int err = 0; |
| 610 | |
| 611 | get_device(dev); |
| 612 | if (adrv->probe) |
| 613 | err = adrv->probe(core); |
| 614 | if (err) |
| 615 | put_device(dev); |
| 616 | |
| 617 | return err; |
| 618 | } |
| 619 | |
| 620 | static void bcma_device_remove(struct device *dev) |
| 621 | { |
| 622 | struct bcma_device *core = container_of(dev, struct bcma_device, dev); |
| 623 | struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver, |
| 624 | drv); |
| 625 | |
| 626 | if (adrv->remove) |
| 627 | adrv->remove(core); |
| 628 | put_device(dev); |
| 629 | } |
| 630 | |
| 631 | static int bcma_device_uevent(const struct device *dev, struct kobj_uevent_env *env) |
| 632 | { |
| 633 | const struct bcma_device *core = container_of_const(dev, struct bcma_device, dev); |
| 634 | |
| 635 | return add_uevent_var(env, |
| 636 | "MODALIAS=bcma:m%04Xid%04Xrev%02Xcl%02X", |
| 637 | core->id.manuf, core->id.id, |
| 638 | core->id.rev, core->id.class); |
| 639 | } |
| 640 | |
| 641 | static unsigned int bcma_bus_registered; |
| 642 | |
| 643 | /* |
| 644 | * If built-in, bus has to be registered early, before any driver calls |
| 645 | * bcma_driver_register. |
| 646 | * Otherwise registering driver would trigger BUG in driver_register. |
| 647 | */ |
| 648 | static int __init bcma_init_bus_register(void) |
| 649 | { |
| 650 | int err; |
| 651 | |
| 652 | if (bcma_bus_registered) |
| 653 | return 0; |
| 654 | |
| 655 | err = bus_register(&bcma_bus_type); |
| 656 | if (!err) |
| 657 | bcma_bus_registered = 1; |
| 658 | |
| 659 | return err; |
| 660 | } |
| 661 | #ifndef MODULE |
| 662 | fs_initcall(bcma_init_bus_register); |
| 663 | #endif |
| 664 | |
| 665 | /* Main initialization has to be done with SPI/mtd/NAND/SPROM available */ |
| 666 | static int __init bcma_modinit(void) |
| 667 | { |
| 668 | int err; |
| 669 | |
| 670 | err = bcma_init_bus_register(); |
| 671 | if (err) |
| 672 | return err; |
| 673 | |
| 674 | err = bcma_host_soc_register_driver(); |
| 675 | if (err) { |
| 676 | pr_err("SoC host initialization failed\n"); |
| 677 | err = 0; |
| 678 | } |
| 679 | #ifdef CONFIG_BCMA_HOST_PCI |
| 680 | err = bcma_host_pci_init(); |
| 681 | if (err) { |
| 682 | pr_err("PCI host initialization failed\n"); |
| 683 | err = 0; |
| 684 | } |
| 685 | #endif |
| 686 | |
| 687 | return err; |
| 688 | } |
| 689 | module_init(bcma_modinit); |
| 690 | |
| 691 | static void __exit bcma_modexit(void) |
| 692 | { |
| 693 | #ifdef CONFIG_BCMA_HOST_PCI |
| 694 | bcma_host_pci_exit(); |
| 695 | #endif |
| 696 | bcma_host_soc_unregister_driver(); |
| 697 | bus_unregister(&bcma_bus_type); |
| 698 | } |
| 699 | module_exit(bcma_modexit) |