2 * Broadcom specific AMBA
5 * Licensed under the GNU/GPL. See COPYING for details.
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_platform.h>
19 MODULE_DESCRIPTION("Broadcom's specific AMBA driver");
20 MODULE_LICENSE("GPL");
22 /* contains the number the next bus should get. */
23 static unsigned int bcma_bus_next_num
= 0;
25 /* bcma_buses_mutex locks the bcma_bus_next_num */
26 static DEFINE_MUTEX(bcma_buses_mutex
);
28 static int bcma_bus_match(struct device
*dev
, struct device_driver
*drv
);
29 static int bcma_device_probe(struct device
*dev
);
30 static int bcma_device_remove(struct device
*dev
);
31 static int bcma_device_uevent(struct device
*dev
, struct kobj_uevent_env
*env
);
33 static ssize_t
manuf_show(struct device
*dev
, struct device_attribute
*attr
, char *buf
)
35 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
36 return sprintf(buf
, "0x%03X\n", core
->id
.manuf
);
38 static DEVICE_ATTR_RO(manuf
);
40 static ssize_t
id_show(struct device
*dev
, struct device_attribute
*attr
, char *buf
)
42 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
43 return sprintf(buf
, "0x%03X\n", core
->id
.id
);
45 static DEVICE_ATTR_RO(id
);
47 static ssize_t
rev_show(struct device
*dev
, struct device_attribute
*attr
, char *buf
)
49 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
50 return sprintf(buf
, "0x%02X\n", core
->id
.rev
);
52 static DEVICE_ATTR_RO(rev
);
54 static ssize_t
class_show(struct device
*dev
, struct device_attribute
*attr
, char *buf
)
56 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
57 return sprintf(buf
, "0x%X\n", core
->id
.class);
59 static DEVICE_ATTR_RO(class);
61 static struct attribute
*bcma_device_attrs
[] = {
68 ATTRIBUTE_GROUPS(bcma_device
);
70 static struct bus_type bcma_bus_type
= {
72 .match
= bcma_bus_match
,
73 .probe
= bcma_device_probe
,
74 .remove
= bcma_device_remove
,
75 .uevent
= bcma_device_uevent
,
76 .dev_groups
= bcma_device_groups
,
79 static u16
bcma_cc_core_id(struct bcma_bus
*bus
)
81 if (bus
->chipinfo
.id
== BCMA_CHIP_ID_BCM4706
)
82 return BCMA_CORE_4706_CHIPCOMMON
;
83 return BCMA_CORE_CHIPCOMMON
;
86 struct bcma_device
*bcma_find_core_unit(struct bcma_bus
*bus
, u16 coreid
,
89 struct bcma_device
*core
;
91 list_for_each_entry(core
, &bus
->cores
, list
) {
92 if (core
->id
.id
== coreid
&& core
->core_unit
== unit
)
97 EXPORT_SYMBOL_GPL(bcma_find_core_unit
);
99 bool bcma_wait_value(struct bcma_device
*core
, u16 reg
, u32 mask
, u32 value
,
102 unsigned long deadline
= jiffies
+ timeout
;
106 val
= bcma_read32(core
, reg
);
107 if ((val
& mask
) == value
)
111 } while (!time_after_eq(jiffies
, deadline
));
113 bcma_warn(core
->bus
, "Timeout waiting for register 0x%04X!\n", reg
);
118 static void bcma_release_core_dev(struct device
*dev
)
120 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
122 iounmap(core
->io_addr
);
124 iounmap(core
->io_wrap
);
128 static bool bcma_is_core_needed_early(u16 core_id
)
131 case BCMA_CORE_NS_NAND
:
132 case BCMA_CORE_NS_QSPI
:
139 static struct device_node
*bcma_of_find_child_device(struct platform_device
*parent
,
140 struct bcma_device
*core
)
142 struct device_node
*node
;
146 if (!parent
|| !parent
->dev
.of_node
)
149 for_each_child_of_node(parent
->dev
.of_node
, node
) {
150 reg
= of_get_address(node
, 0, &size
, NULL
);
153 if (of_translate_address(node
, reg
) == core
->addr
)
159 static int bcma_of_irq_parse(struct platform_device
*parent
,
160 struct bcma_device
*core
,
161 struct of_phandle_args
*out_irq
, int num
)
166 if (core
->dev
.of_node
) {
167 rc
= of_irq_parse_one(core
->dev
.of_node
, num
, out_irq
);
172 out_irq
->np
= parent
->dev
.of_node
;
173 out_irq
->args_count
= 1;
174 out_irq
->args
[0] = num
;
176 laddr
[0] = cpu_to_be32(core
->addr
);
177 return of_irq_parse_raw(laddr
, out_irq
);
180 static unsigned int bcma_of_get_irq(struct platform_device
*parent
,
181 struct bcma_device
*core
, int num
)
183 struct of_phandle_args out_irq
;
186 if (!IS_ENABLED(CONFIG_OF_IRQ
) || !parent
|| !parent
->dev
.of_node
)
189 ret
= bcma_of_irq_parse(parent
, core
, &out_irq
, num
);
191 bcma_debug(core
->bus
, "bcma_of_get_irq() failed with rc=%d\n",
196 return irq_create_of_mapping(&out_irq
);
199 static void bcma_of_fill_device(struct platform_device
*parent
,
200 struct bcma_device
*core
)
202 struct device_node
*node
;
204 if (!IS_ENABLED(CONFIG_OF_IRQ
))
207 node
= bcma_of_find_child_device(parent
, core
);
209 core
->dev
.of_node
= node
;
211 core
->irq
= bcma_of_get_irq(parent
, core
, 0);
213 of_dma_configure(&core
->dev
, node
);
216 unsigned int bcma_core_irq(struct bcma_device
*core
, int num
)
218 struct bcma_bus
*bus
= core
->bus
;
219 unsigned int mips_irq
;
221 switch (bus
->hosttype
) {
222 case BCMA_HOSTTYPE_PCI
:
223 return bus
->host_pci
->irq
;
224 case BCMA_HOSTTYPE_SOC
:
225 if (bus
->drv_mips
.core
&& num
== 0) {
226 mips_irq
= bcma_core_mips_irq(core
);
227 return mips_irq
<= 4 ? mips_irq
+ 2 : 0;
230 return bcma_of_get_irq(bus
->host_pdev
, core
, num
);
232 case BCMA_HOSTTYPE_SDIO
:
238 EXPORT_SYMBOL(bcma_core_irq
);
240 void bcma_prepare_core(struct bcma_bus
*bus
, struct bcma_device
*core
)
242 core
->dev
.release
= bcma_release_core_dev
;
243 core
->dev
.bus
= &bcma_bus_type
;
244 dev_set_name(&core
->dev
, "bcma%d:%d", bus
->num
, core
->core_index
);
246 switch (bus
->hosttype
) {
247 case BCMA_HOSTTYPE_PCI
:
248 core
->dev
.parent
= &bus
->host_pci
->dev
;
249 core
->dma_dev
= &bus
->host_pci
->dev
;
250 core
->irq
= bus
->host_pci
->irq
;
252 case BCMA_HOSTTYPE_SOC
:
253 if (IS_ENABLED(CONFIG_OF
) && bus
->host_pdev
) {
254 core
->dma_dev
= &bus
->host_pdev
->dev
;
255 core
->dev
.parent
= &bus
->host_pdev
->dev
;
256 bcma_of_fill_device(bus
->host_pdev
, core
);
258 core
->dev
.dma_mask
= &core
->dev
.coherent_dma_mask
;
259 core
->dma_dev
= &core
->dev
;
262 case BCMA_HOSTTYPE_SDIO
:
267 struct device
*bcma_bus_get_host_dev(struct bcma_bus
*bus
)
269 switch (bus
->hosttype
) {
270 case BCMA_HOSTTYPE_PCI
:
272 return &bus
->host_pci
->dev
;
275 case BCMA_HOSTTYPE_SOC
:
277 return &bus
->host_pdev
->dev
;
280 case BCMA_HOSTTYPE_SDIO
:
282 return &bus
->host_sdio
->dev
;
289 void bcma_init_bus(struct bcma_bus
*bus
)
291 mutex_lock(&bcma_buses_mutex
);
292 bus
->num
= bcma_bus_next_num
++;
293 mutex_unlock(&bcma_buses_mutex
);
295 INIT_LIST_HEAD(&bus
->cores
);
298 bcma_detect_chip(bus
);
301 static void bcma_register_core(struct bcma_bus
*bus
, struct bcma_device
*core
)
305 err
= device_register(&core
->dev
);
307 bcma_err(bus
, "Could not register dev for core 0x%03X\n",
309 put_device(&core
->dev
);
312 core
->dev_registered
= true;
315 static int bcma_register_devices(struct bcma_bus
*bus
)
317 struct bcma_device
*core
;
320 list_for_each_entry(core
, &bus
->cores
, list
) {
321 /* We support that cores ourself */
322 switch (core
->id
.id
) {
323 case BCMA_CORE_4706_CHIPCOMMON
:
324 case BCMA_CORE_CHIPCOMMON
:
325 case BCMA_CORE_NS_CHIPCOMMON_B
:
328 case BCMA_CORE_PCIE2
:
329 case BCMA_CORE_MIPS_74K
:
330 case BCMA_CORE_4706_MAC_GBIT_COMMON
:
334 /* Early cores were already registered */
335 if (bcma_is_core_needed_early(core
->id
.id
))
338 /* Only first GMAC core on BCM4706 is connected and working */
339 if (core
->id
.id
== BCMA_CORE_4706_MAC_GBIT
&&
343 bcma_register_core(bus
, core
);
346 #ifdef CONFIG_BCMA_PFLASH
347 if (bus
->drv_cc
.pflash
.present
) {
348 err
= platform_device_register(&bcma_pflash_dev
);
350 bcma_err(bus
, "Error registering parallel flash\n");
354 #ifdef CONFIG_BCMA_SFLASH
355 if (bus
->drv_cc
.sflash
.present
) {
356 err
= platform_device_register(&bcma_sflash_dev
);
358 bcma_err(bus
, "Error registering serial flash\n");
362 #ifdef CONFIG_BCMA_NFLASH
363 if (bus
->drv_cc
.nflash
.present
) {
364 err
= platform_device_register(&bcma_nflash_dev
);
366 bcma_err(bus
, "Error registering NAND flash\n");
369 err
= bcma_gpio_init(&bus
->drv_cc
);
370 if (err
== -ENOTSUPP
)
371 bcma_debug(bus
, "GPIO driver not activated\n");
373 bcma_err(bus
, "Error registering GPIO driver: %i\n", err
);
375 if (bus
->hosttype
== BCMA_HOSTTYPE_SOC
) {
376 err
= bcma_chipco_watchdog_register(&bus
->drv_cc
);
378 bcma_err(bus
, "Error registering watchdog driver\n");
384 void bcma_unregister_cores(struct bcma_bus
*bus
)
386 struct bcma_device
*core
, *tmp
;
388 list_for_each_entry_safe(core
, tmp
, &bus
->cores
, list
) {
389 if (!core
->dev_registered
)
391 list_del(&core
->list
);
392 device_unregister(&core
->dev
);
394 if (bus
->hosttype
== BCMA_HOSTTYPE_SOC
)
395 platform_device_unregister(bus
->drv_cc
.watchdog
);
397 /* Now noone uses internally-handled cores, we can free them */
398 list_for_each_entry_safe(core
, tmp
, &bus
->cores
, list
) {
399 list_del(&core
->list
);
404 int bcma_bus_register(struct bcma_bus
*bus
)
407 struct bcma_device
*core
;
410 /* Scan for devices (cores) */
411 err
= bcma_bus_scan(bus
);
413 bcma_err(bus
, "Failed to scan: %d\n", err
);
417 /* Early init CC core */
418 core
= bcma_find_core(bus
, bcma_cc_core_id(bus
));
420 bus
->drv_cc
.core
= core
;
421 bcma_core_chipcommon_early_init(&bus
->drv_cc
);
424 /* Early init PCIE core */
425 core
= bcma_find_core(bus
, BCMA_CORE_PCIE
);
427 bus
->drv_pci
[0].core
= core
;
428 bcma_core_pci_early_init(&bus
->drv_pci
[0]);
431 dev
= bcma_bus_get_host_dev(bus
);
433 of_platform_default_populate(dev
->of_node
, NULL
, dev
);
436 /* Cores providing flash access go before SPROM init */
437 list_for_each_entry(core
, &bus
->cores
, list
) {
438 if (bcma_is_core_needed_early(core
->id
.id
))
439 bcma_register_core(bus
, core
);
442 /* Try to get SPROM */
443 err
= bcma_sprom_get(bus
);
444 if (err
== -ENOENT
) {
445 bcma_err(bus
, "No SPROM available\n");
447 bcma_err(bus
, "Failed to get SPROM: %d\n", err
);
450 core
= bcma_find_core(bus
, bcma_cc_core_id(bus
));
452 bus
->drv_cc
.core
= core
;
453 bcma_core_chipcommon_init(&bus
->drv_cc
);
457 core
= bcma_find_core(bus
, BCMA_CORE_NS_CHIPCOMMON_B
);
459 bus
->drv_cc_b
.core
= core
;
460 bcma_core_chipcommon_b_init(&bus
->drv_cc_b
);
464 core
= bcma_find_core(bus
, BCMA_CORE_MIPS_74K
);
466 bus
->drv_mips
.core
= core
;
467 bcma_core_mips_init(&bus
->drv_mips
);
471 core
= bcma_find_core_unit(bus
, BCMA_CORE_PCIE
, 0);
473 bus
->drv_pci
[0].core
= core
;
474 bcma_core_pci_init(&bus
->drv_pci
[0]);
478 core
= bcma_find_core_unit(bus
, BCMA_CORE_PCIE
, 1);
480 bus
->drv_pci
[1].core
= core
;
481 bcma_core_pci_init(&bus
->drv_pci
[1]);
484 /* Init PCIe Gen 2 core */
485 core
= bcma_find_core_unit(bus
, BCMA_CORE_PCIE2
, 0);
487 bus
->drv_pcie2
.core
= core
;
488 bcma_core_pcie2_init(&bus
->drv_pcie2
);
491 /* Init GBIT MAC COMMON core */
492 core
= bcma_find_core(bus
, BCMA_CORE_4706_MAC_GBIT_COMMON
);
494 bus
->drv_gmac_cmn
.core
= core
;
495 bcma_core_gmac_cmn_init(&bus
->drv_gmac_cmn
);
498 /* Register found cores */
499 bcma_register_devices(bus
);
501 bcma_info(bus
, "Bus registered\n");
506 void bcma_bus_unregister(struct bcma_bus
*bus
)
510 err
= bcma_gpio_unregister(&bus
->drv_cc
);
512 bcma_err(bus
, "Some GPIOs are still in use.\n");
514 bcma_err(bus
, "Can not unregister GPIO driver: %i\n", err
);
516 bcma_core_chipcommon_b_free(&bus
->drv_cc_b
);
518 bcma_unregister_cores(bus
);
522 * This is a special version of bus registration function designed for SoCs.
523 * It scans bus and performs basic initialization of main cores only.
524 * Please note it requires memory allocation, however it won't try to sleep.
526 int __init
bcma_bus_early_register(struct bcma_bus
*bus
)
529 struct bcma_device
*core
;
531 /* Scan for devices (cores) */
532 err
= bcma_bus_scan(bus
);
534 bcma_err(bus
, "Failed to scan bus: %d\n", err
);
538 /* Early init CC core */
539 core
= bcma_find_core(bus
, bcma_cc_core_id(bus
));
541 bus
->drv_cc
.core
= core
;
542 bcma_core_chipcommon_early_init(&bus
->drv_cc
);
545 /* Early init MIPS core */
546 core
= bcma_find_core(bus
, BCMA_CORE_MIPS_74K
);
548 bus
->drv_mips
.core
= core
;
549 bcma_core_mips_early_init(&bus
->drv_mips
);
552 bcma_info(bus
, "Early bus registered\n");
558 int bcma_bus_suspend(struct bcma_bus
*bus
)
560 struct bcma_device
*core
;
562 list_for_each_entry(core
, &bus
->cores
, list
) {
563 struct device_driver
*drv
= core
->dev
.driver
;
565 struct bcma_driver
*adrv
= container_of(drv
, struct bcma_driver
, drv
);
573 int bcma_bus_resume(struct bcma_bus
*bus
)
575 struct bcma_device
*core
;
578 if (bus
->drv_cc
.core
) {
579 bus
->drv_cc
.setup_done
= false;
580 bcma_core_chipcommon_init(&bus
->drv_cc
);
583 list_for_each_entry(core
, &bus
->cores
, list
) {
584 struct device_driver
*drv
= core
->dev
.driver
;
586 struct bcma_driver
*adrv
= container_of(drv
, struct bcma_driver
, drv
);
596 int __bcma_driver_register(struct bcma_driver
*drv
, struct module
*owner
)
598 drv
->drv
.name
= drv
->name
;
599 drv
->drv
.bus
= &bcma_bus_type
;
600 drv
->drv
.owner
= owner
;
602 return driver_register(&drv
->drv
);
604 EXPORT_SYMBOL_GPL(__bcma_driver_register
);
606 void bcma_driver_unregister(struct bcma_driver
*drv
)
608 driver_unregister(&drv
->drv
);
610 EXPORT_SYMBOL_GPL(bcma_driver_unregister
);
612 static int bcma_bus_match(struct device
*dev
, struct device_driver
*drv
)
614 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
615 struct bcma_driver
*adrv
= container_of(drv
, struct bcma_driver
, drv
);
616 const struct bcma_device_id
*cid
= &core
->id
;
617 const struct bcma_device_id
*did
;
619 for (did
= adrv
->id_table
; did
->manuf
|| did
->id
|| did
->rev
; did
++) {
620 if ((did
->manuf
== cid
->manuf
|| did
->manuf
== BCMA_ANY_MANUF
) &&
621 (did
->id
== cid
->id
|| did
->id
== BCMA_ANY_ID
) &&
622 (did
->rev
== cid
->rev
|| did
->rev
== BCMA_ANY_REV
) &&
623 (did
->class == cid
->class || did
->class == BCMA_ANY_CLASS
))
629 static int bcma_device_probe(struct device
*dev
)
631 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
632 struct bcma_driver
*adrv
= container_of(dev
->driver
, struct bcma_driver
,
637 err
= adrv
->probe(core
);
642 static int bcma_device_remove(struct device
*dev
)
644 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
645 struct bcma_driver
*adrv
= container_of(dev
->driver
, struct bcma_driver
,
654 static int bcma_device_uevent(struct device
*dev
, struct kobj_uevent_env
*env
)
656 struct bcma_device
*core
= container_of(dev
, struct bcma_device
, dev
);
658 return add_uevent_var(env
,
659 "MODALIAS=bcma:m%04Xid%04Xrev%02Xcl%02X",
660 core
->id
.manuf
, core
->id
.id
,
661 core
->id
.rev
, core
->id
.class);
664 static unsigned int bcma_bus_registered
;
667 * If built-in, bus has to be registered early, before any driver calls
668 * bcma_driver_register.
669 * Otherwise registering driver would trigger BUG in driver_register.
671 static int __init
bcma_init_bus_register(void)
675 if (bcma_bus_registered
)
678 err
= bus_register(&bcma_bus_type
);
680 bcma_bus_registered
= 1;
685 fs_initcall(bcma_init_bus_register
);
688 /* Main initialization has to be done with SPI/mtd/NAND/SPROM available */
689 static int __init
bcma_modinit(void)
693 err
= bcma_init_bus_register();
697 err
= bcma_host_soc_register_driver();
699 pr_err("SoC host initialization failed\n");
702 #ifdef CONFIG_BCMA_HOST_PCI
703 err
= bcma_host_pci_init();
705 pr_err("PCI host initialization failed\n");
712 module_init(bcma_modinit
);
714 static void __exit
bcma_modexit(void)
716 #ifdef CONFIG_BCMA_HOST_PCI
717 bcma_host_pci_exit();
719 bcma_host_soc_unregister_driver();
720 bus_unregister(&bcma_bus_type
);
722 module_exit(bcma_modexit
)