18369ae33SRafał Miłecki /*
28369ae33SRafał Miłecki * Broadcom specific AMBA
38369ae33SRafał Miłecki * Bus subsystem
48369ae33SRafał Miłecki *
58369ae33SRafał Miłecki * Licensed under the GNU/GPL. See COPYING for details.
68369ae33SRafał Miłecki */
78369ae33SRafał Miłecki
88369ae33SRafał Miłecki #include "bcma_private.h"
9200351c7SPaul Gortmaker #include <linux/module.h>
1053cd2fdbSHauke Mehrtens #include <linux/mmc/sdio_func.h>
11d57ef3a6SRafał Miłecki #include <linux/platform_device.h>
1253cd2fdbSHauke Mehrtens #include <linux/pci.h>
138369ae33SRafał Miłecki #include <linux/bcma/bcma.h>
14eef72699SGeert Uytterhoeven #include <linux/slab.h>
152101e533SHauke Mehrtens #include <linux/of_address.h>
1671783576SHauke Mehrtens #include <linux/of_irq.h>
17*666f4ab2SRob Herring #include <linux/of_device.h>
18cae761b5SRafał Miłecki #include <linux/of_platform.h>
198369ae33SRafał Miłecki
208369ae33SRafał Miłecki MODULE_DESCRIPTION("Broadcom's specific AMBA driver");
218369ae33SRafał Miłecki MODULE_LICENSE("GPL");
228369ae33SRafał Miłecki
238f9ada4fSHauke Mehrtens /* contains the number the next bus should get. */
245668958fSSohaib Mohamed static unsigned int bcma_bus_next_num;
258f9ada4fSHauke Mehrtens
268f9ada4fSHauke Mehrtens /* bcma_buses_mutex locks the bcma_bus_next_num */
278f9ada4fSHauke Mehrtens static DEFINE_MUTEX(bcma_buses_mutex);
288f9ada4fSHauke Mehrtens
298369ae33SRafał Miłecki static int bcma_bus_match(struct device *dev, struct device_driver *drv);
308369ae33SRafał Miłecki static int bcma_device_probe(struct device *dev);
31fc7a6209SUwe Kleine-König static void bcma_device_remove(struct device *dev);
322a81ada3SGreg Kroah-Hartman static int bcma_device_uevent(const struct device *dev, struct kobj_uevent_env *env);
338369ae33SRafał Miłecki
manuf_show(struct device * dev,struct device_attribute * attr,char * buf)348369ae33SRafał Miłecki static ssize_t manuf_show(struct device *dev, struct device_attribute *attr, char *buf)
358369ae33SRafał Miłecki {
368369ae33SRafał Miłecki struct bcma_device *core = container_of(dev, struct bcma_device, dev);
378369ae33SRafał Miłecki return sprintf(buf, "0x%03X\n", core->id.manuf);
388369ae33SRafał Miłecki }
39fdcf4f81SGreg Kroah-Hartman static DEVICE_ATTR_RO(manuf);
40fdcf4f81SGreg Kroah-Hartman
id_show(struct device * dev,struct device_attribute * attr,char * buf)418369ae33SRafał Miłecki static ssize_t id_show(struct device *dev, struct device_attribute *attr, char *buf)
428369ae33SRafał Miłecki {
438369ae33SRafał Miłecki struct bcma_device *core = container_of(dev, struct bcma_device, dev);
448369ae33SRafał Miłecki return sprintf(buf, "0x%03X\n", core->id.id);
458369ae33SRafał Miłecki }
46fdcf4f81SGreg Kroah-Hartman static DEVICE_ATTR_RO(id);
47fdcf4f81SGreg Kroah-Hartman
rev_show(struct device * dev,struct device_attribute * attr,char * buf)488369ae33SRafał Miłecki static ssize_t rev_show(struct device *dev, struct device_attribute *attr, char *buf)
498369ae33SRafał Miłecki {
508369ae33SRafał Miłecki struct bcma_device *core = container_of(dev, struct bcma_device, dev);
518369ae33SRafał Miłecki return sprintf(buf, "0x%02X\n", core->id.rev);
528369ae33SRafał Miłecki }
53fdcf4f81SGreg Kroah-Hartman static DEVICE_ATTR_RO(rev);
54fdcf4f81SGreg Kroah-Hartman
class_show(struct device * dev,struct device_attribute * attr,char * buf)558369ae33SRafał Miłecki static ssize_t class_show(struct device *dev, struct device_attribute *attr, char *buf)
568369ae33SRafał Miłecki {
578369ae33SRafał Miłecki struct bcma_device *core = container_of(dev, struct bcma_device, dev);
588369ae33SRafał Miłecki return sprintf(buf, "0x%X\n", core->id.class);
598369ae33SRafał Miłecki }
60fdcf4f81SGreg Kroah-Hartman static DEVICE_ATTR_RO(class);
61fdcf4f81SGreg Kroah-Hartman
62fdcf4f81SGreg Kroah-Hartman static struct attribute *bcma_device_attrs[] = {
63fdcf4f81SGreg Kroah-Hartman &dev_attr_manuf.attr,
64fdcf4f81SGreg Kroah-Hartman &dev_attr_id.attr,
65fdcf4f81SGreg Kroah-Hartman &dev_attr_rev.attr,
66fdcf4f81SGreg Kroah-Hartman &dev_attr_class.attr,
67fdcf4f81SGreg Kroah-Hartman NULL,
688369ae33SRafał Miłecki };
69fdcf4f81SGreg Kroah-Hartman ATTRIBUTE_GROUPS(bcma_device);
708369ae33SRafał Miłecki
718369ae33SRafał Miłecki static struct bus_type bcma_bus_type = {
728369ae33SRafał Miłecki .name = "bcma",
738369ae33SRafał Miłecki .match = bcma_bus_match,
748369ae33SRafał Miłecki .probe = bcma_device_probe,
758369ae33SRafał Miłecki .remove = bcma_device_remove,
76886b66efSDavid Woodhouse .uevent = bcma_device_uevent,
77fdcf4f81SGreg Kroah-Hartman .dev_groups = bcma_device_groups,
788369ae33SRafał Miłecki };
798369ae33SRafał Miłecki
bcma_cc_core_id(struct bcma_bus * bus)806d5cfc9fSRafał Miłecki static u16 bcma_cc_core_id(struct bcma_bus *bus)
816d5cfc9fSRafał Miłecki {
826d5cfc9fSRafał Miłecki if (bus->chipinfo.id == BCMA_CHIP_ID_BCM4706)
836d5cfc9fSRafał Miłecki return BCMA_CORE_4706_CHIPCOMMON;
846d5cfc9fSRafał Miłecki return BCMA_CORE_CHIPCOMMON;
856d5cfc9fSRafał Miłecki }
866d5cfc9fSRafał Miłecki
bcma_find_core_unit(struct bcma_bus * bus,u16 coreid,u8 unit)87929a03aeSHauke Mehrtens struct bcma_device *bcma_find_core_unit(struct bcma_bus *bus, u16 coreid,
88dfae7143SHauke Mehrtens u8 unit)
89dfae7143SHauke Mehrtens {
90dfae7143SHauke Mehrtens struct bcma_device *core;
91dfae7143SHauke Mehrtens
92dfae7143SHauke Mehrtens list_for_each_entry(core, &bus->cores, list) {
93dfae7143SHauke Mehrtens if (core->id.id == coreid && core->core_unit == unit)
94dfae7143SHauke Mehrtens return core;
95dfae7143SHauke Mehrtens }
96dfae7143SHauke Mehrtens return NULL;
97dfae7143SHauke Mehrtens }
98b2395b8aSHauke Mehrtens EXPORT_SYMBOL_GPL(bcma_find_core_unit);
99dfae7143SHauke Mehrtens
bcma_wait_value(struct bcma_device * core,u16 reg,u32 mask,u32 value,int timeout)10088f9b65dSRafał Miłecki bool bcma_wait_value(struct bcma_device *core, u16 reg, u32 mask, u32 value,
10188f9b65dSRafał Miłecki int timeout)
10288f9b65dSRafał Miłecki {
10388f9b65dSRafał Miłecki unsigned long deadline = jiffies + timeout;
10488f9b65dSRafał Miłecki u32 val;
10588f9b65dSRafał Miłecki
10688f9b65dSRafał Miłecki do {
10788f9b65dSRafał Miłecki val = bcma_read32(core, reg);
10888f9b65dSRafał Miłecki if ((val & mask) == value)
10988f9b65dSRafał Miłecki return true;
11088f9b65dSRafał Miłecki cpu_relax();
11188f9b65dSRafał Miłecki udelay(10);
11288f9b65dSRafał Miłecki } while (!time_after_eq(jiffies, deadline));
11388f9b65dSRafał Miłecki
11488f9b65dSRafał Miłecki bcma_warn(core->bus, "Timeout waiting for register 0x%04X!\n", reg);
11588f9b65dSRafał Miłecki
11688f9b65dSRafał Miłecki return false;
11788f9b65dSRafał Miłecki }
11888f9b65dSRafał Miłecki
bcma_release_core_dev(struct device * dev)1198369ae33SRafał Miłecki static void bcma_release_core_dev(struct device *dev)
1208369ae33SRafał Miłecki {
1218369ae33SRafał Miłecki struct bcma_device *core = container_of(dev, struct bcma_device, dev);
122ecd177c2SHauke Mehrtens if (core->io_addr)
123ecd177c2SHauke Mehrtens iounmap(core->io_addr);
124ecd177c2SHauke Mehrtens if (core->io_wrap)
125ecd177c2SHauke Mehrtens iounmap(core->io_wrap);
1268369ae33SRafał Miłecki kfree(core);
1278369ae33SRafał Miłecki }
1288369ae33SRafał Miłecki
bcma_is_core_needed_early(u16 core_id)12937a7f876SRafał Miłecki static bool bcma_is_core_needed_early(u16 core_id)
13037a7f876SRafał Miłecki {
13137a7f876SRafał Miłecki switch (core_id) {
13237a7f876SRafał Miłecki case BCMA_CORE_NS_NAND:
13337a7f876SRafał Miłecki case BCMA_CORE_NS_QSPI:
13437a7f876SRafał Miłecki return true;
13537a7f876SRafał Miłecki }
13637a7f876SRafał Miłecki
13737a7f876SRafał Miłecki return false;
13837a7f876SRafał Miłecki }
13937a7f876SRafał Miłecki
bcma_of_find_child_device(struct device * parent,struct bcma_device * core)140b1a4c9a1SRafał Miłecki static struct device_node *bcma_of_find_child_device(struct device *parent,
1412101e533SHauke Mehrtens struct bcma_device *core)
1422101e533SHauke Mehrtens {
1432101e533SHauke Mehrtens struct device_node *node;
144767d011dSRob Herring int ret;
1452101e533SHauke Mehrtens
146b1a4c9a1SRafał Miłecki if (!parent->of_node)
1472101e533SHauke Mehrtens return NULL;
1482101e533SHauke Mehrtens
149b1a4c9a1SRafał Miłecki for_each_child_of_node(parent->of_node, node) {
150767d011dSRob Herring struct resource res;
151767d011dSRob Herring ret = of_address_to_resource(node, 0, &res);
152767d011dSRob Herring if (ret)
1532101e533SHauke Mehrtens continue;
154767d011dSRob Herring if (res.start == core->addr)
1552101e533SHauke Mehrtens return node;
1562101e533SHauke Mehrtens }
1572101e533SHauke Mehrtens return NULL;
1582101e533SHauke Mehrtens }
1592101e533SHauke Mehrtens
bcma_of_irq_parse(struct device * parent,struct bcma_device * core,struct of_phandle_args * out_irq,int num)160b1a4c9a1SRafał Miłecki static int bcma_of_irq_parse(struct device *parent,
16171783576SHauke Mehrtens struct bcma_device *core,
16271783576SHauke Mehrtens struct of_phandle_args *out_irq, int num)
16371783576SHauke Mehrtens {
16471783576SHauke Mehrtens __be32 laddr[1];
16571783576SHauke Mehrtens int rc;
16671783576SHauke Mehrtens
16771783576SHauke Mehrtens if (core->dev.of_node) {
16871783576SHauke Mehrtens rc = of_irq_parse_one(core->dev.of_node, num, out_irq);
16971783576SHauke Mehrtens if (!rc)
17071783576SHauke Mehrtens return rc;
17171783576SHauke Mehrtens }
17271783576SHauke Mehrtens
173b1a4c9a1SRafał Miłecki out_irq->np = parent->of_node;
17471783576SHauke Mehrtens out_irq->args_count = 1;
17571783576SHauke Mehrtens out_irq->args[0] = num;
17671783576SHauke Mehrtens
17771783576SHauke Mehrtens laddr[0] = cpu_to_be32(core->addr);
17871783576SHauke Mehrtens return of_irq_parse_raw(laddr, out_irq);
17971783576SHauke Mehrtens }
18071783576SHauke Mehrtens
bcma_of_get_irq(struct device * parent,struct bcma_device * core,int num)181b1a4c9a1SRafał Miłecki static unsigned int bcma_of_get_irq(struct device *parent,
18271783576SHauke Mehrtens struct bcma_device *core, int num)
18371783576SHauke Mehrtens {
18471783576SHauke Mehrtens struct of_phandle_args out_irq;
18571783576SHauke Mehrtens int ret;
18671783576SHauke Mehrtens
187b1a4c9a1SRafał Miłecki if (!IS_ENABLED(CONFIG_OF_IRQ) || !parent->of_node)
18871783576SHauke Mehrtens return 0;
18971783576SHauke Mehrtens
19071783576SHauke Mehrtens ret = bcma_of_irq_parse(parent, core, &out_irq, num);
19171783576SHauke Mehrtens if (ret) {
19271783576SHauke Mehrtens bcma_debug(core->bus, "bcma_of_get_irq() failed with rc=%d\n",
19371783576SHauke Mehrtens ret);
19471783576SHauke Mehrtens return 0;
19571783576SHauke Mehrtens }
19671783576SHauke Mehrtens
19771783576SHauke Mehrtens return irq_create_of_mapping(&out_irq);
19871783576SHauke Mehrtens }
19971783576SHauke Mehrtens
bcma_of_fill_device(struct device * parent,struct bcma_device * core)200b1a4c9a1SRafał Miłecki static void bcma_of_fill_device(struct device *parent,
2012101e533SHauke Mehrtens struct bcma_device *core)
2022101e533SHauke Mehrtens {
2032101e533SHauke Mehrtens struct device_node *node;
2042101e533SHauke Mehrtens
2052101e533SHauke Mehrtens node = bcma_of_find_child_device(parent, core);
2062101e533SHauke Mehrtens if (node)
2072101e533SHauke Mehrtens core->dev.of_node = node;
20871783576SHauke Mehrtens
20971783576SHauke Mehrtens core->irq = bcma_of_get_irq(parent, core, 0);
210defb893fSArnd Bergmann
2113d6ce86eSChristoph Hellwig of_dma_configure(&core->dev, node, false);
2122101e533SHauke Mehrtens }
2132101e533SHauke Mehrtens
bcma_core_irq(struct bcma_device * core,int num)21485eb92e8SHauke Mehrtens unsigned int bcma_core_irq(struct bcma_device *core, int num)
21585eb92e8SHauke Mehrtens {
21685eb92e8SHauke Mehrtens struct bcma_bus *bus = core->bus;
21785eb92e8SHauke Mehrtens unsigned int mips_irq;
21885eb92e8SHauke Mehrtens
21985eb92e8SHauke Mehrtens switch (bus->hosttype) {
22085eb92e8SHauke Mehrtens case BCMA_HOSTTYPE_PCI:
22185eb92e8SHauke Mehrtens return bus->host_pci->irq;
22285eb92e8SHauke Mehrtens case BCMA_HOSTTYPE_SOC:
22385eb92e8SHauke Mehrtens if (bus->drv_mips.core && num == 0) {
22485eb92e8SHauke Mehrtens mips_irq = bcma_core_mips_irq(core);
22585eb92e8SHauke Mehrtens return mips_irq <= 4 ? mips_irq + 2 : 0;
22685eb92e8SHauke Mehrtens }
2275a1c18b7SRafał Miłecki if (bus->dev)
2285a1c18b7SRafał Miłecki return bcma_of_get_irq(bus->dev, core, num);
22971783576SHauke Mehrtens return 0;
23085eb92e8SHauke Mehrtens case BCMA_HOSTTYPE_SDIO:
23185eb92e8SHauke Mehrtens return 0;
23285eb92e8SHauke Mehrtens }
23385eb92e8SHauke Mehrtens
23485eb92e8SHauke Mehrtens return 0;
23585eb92e8SHauke Mehrtens }
23685eb92e8SHauke Mehrtens EXPORT_SYMBOL(bcma_core_irq);
23785eb92e8SHauke Mehrtens
bcma_prepare_core(struct bcma_bus * bus,struct bcma_device * core)238ab54bc84SRafał Miłecki void bcma_prepare_core(struct bcma_bus *bus, struct bcma_device *core)
2396e094bd8SRafał Miłecki {
240b63aed3fSZenghui Yu device_initialize(&core->dev);
2416e094bd8SRafał Miłecki core->dev.release = bcma_release_core_dev;
2426e094bd8SRafał Miłecki core->dev.bus = &bcma_bus_type;
2436e094bd8SRafał Miłecki dev_set_name(&core->dev, "bcma%d:%d", bus->num, core->core_index);
2445a1c18b7SRafał Miłecki core->dev.parent = bus->dev;
2455a1c18b7SRafał Miłecki if (bus->dev)
2465a1c18b7SRafał Miłecki bcma_of_fill_device(bus->dev, core);
2476e094bd8SRafał Miłecki
2486e094bd8SRafał Miłecki switch (bus->hosttype) {
2496e094bd8SRafał Miłecki case BCMA_HOSTTYPE_PCI:
2505a1c18b7SRafał Miłecki core->dma_dev = bus->dev;
2516e094bd8SRafał Miłecki core->irq = bus->host_pci->irq;
2526e094bd8SRafał Miłecki break;
2536e094bd8SRafał Miłecki case BCMA_HOSTTYPE_SOC:
2545a1c18b7SRafał Miłecki if (IS_ENABLED(CONFIG_OF) && bus->dev) {
2555a1c18b7SRafał Miłecki core->dma_dev = bus->dev;
2562101e533SHauke Mehrtens } else {
257defb893fSArnd Bergmann core->dev.dma_mask = &core->dev.coherent_dma_mask;
2586e094bd8SRafał Miłecki core->dma_dev = &core->dev;
2592101e533SHauke Mehrtens }
2606e094bd8SRafał Miłecki break;
2616e094bd8SRafał Miłecki case BCMA_HOSTTYPE_SDIO:
2626e094bd8SRafał Miłecki break;
2636e094bd8SRafał Miłecki }
264ab54bc84SRafał Miłecki }
265ab54bc84SRafał Miłecki
bcma_init_bus(struct bcma_bus * bus)266799038eaSRafał Miłecki void bcma_init_bus(struct bcma_bus *bus)
267799038eaSRafał Miłecki {
268799038eaSRafał Miłecki mutex_lock(&bcma_buses_mutex);
269799038eaSRafał Miłecki bus->num = bcma_bus_next_num++;
270799038eaSRafał Miłecki mutex_unlock(&bcma_buses_mutex);
271799038eaSRafał Miłecki
272799038eaSRafał Miłecki INIT_LIST_HEAD(&bus->cores);
273799038eaSRafał Miłecki bus->nr_cores = 0;
274799038eaSRafał Miłecki
275799038eaSRafał Miłecki bcma_detect_chip(bus);
276799038eaSRafał Miłecki }
277799038eaSRafał Miłecki
bcma_register_core(struct bcma_bus * bus,struct bcma_device * core)278ab54bc84SRafał Miłecki static void bcma_register_core(struct bcma_bus *bus, struct bcma_device *core)
279ab54bc84SRafał Miłecki {
280ab54bc84SRafał Miłecki int err;
2816e094bd8SRafał Miłecki
282b63aed3fSZenghui Yu err = device_add(&core->dev);
2836e094bd8SRafał Miłecki if (err) {
2846e094bd8SRafał Miłecki bcma_err(bus, "Could not register dev for core 0x%03X\n",
2856e094bd8SRafał Miłecki core->id.id);
2866e094bd8SRafał Miłecki return;
2876e094bd8SRafał Miłecki }
2886e094bd8SRafał Miłecki core->dev_registered = true;
2896e094bd8SRafał Miłecki }
2906e094bd8SRafał Miłecki
bcma_register_devices(struct bcma_bus * bus)2916e094bd8SRafał Miłecki static int bcma_register_devices(struct bcma_bus *bus)
2928369ae33SRafał Miłecki {
2938369ae33SRafał Miłecki struct bcma_device *core;
2946e094bd8SRafał Miłecki int err;
2958369ae33SRafał Miłecki
2968369ae33SRafał Miłecki list_for_each_entry(core, &bus->cores, list) {
297032931fdSTom Rix /* We support that core ourselves */
2988369ae33SRafał Miłecki switch (core->id.id) {
2996d5cfc9fSRafał Miłecki case BCMA_CORE_4706_CHIPCOMMON:
3008369ae33SRafał Miłecki case BCMA_CORE_CHIPCOMMON:
3011716bcf3SHauke Mehrtens case BCMA_CORE_NS_CHIPCOMMON_B:
3028369ae33SRafał Miłecki case BCMA_CORE_PCI:
3038369ae33SRafał Miłecki case BCMA_CORE_PCIE:
304f473832fSRafał Miłecki case BCMA_CORE_PCIE2:
30521e0534aSHauke Mehrtens case BCMA_CORE_MIPS_74K:
306e1ac4b40SRafał Miłecki case BCMA_CORE_4706_MAC_GBIT_COMMON:
3078369ae33SRafał Miłecki continue;
3088369ae33SRafał Miłecki }
3098369ae33SRafał Miłecki
31037a7f876SRafał Miłecki /* Early cores were already registered */
31137a7f876SRafał Miłecki if (bcma_is_core_needed_early(core->id.id))
31237a7f876SRafał Miłecki continue;
31337a7f876SRafał Miłecki
31410419d08SRafał Miłecki /* Only first GMAC core on BCM4706 is connected and working */
31510419d08SRafał Miłecki if (core->id.id == BCMA_CORE_4706_MAC_GBIT &&
31610419d08SRafał Miłecki core->core_unit > 0)
31710419d08SRafał Miłecki continue;
31810419d08SRafał Miłecki
3196e094bd8SRafał Miłecki bcma_register_core(bus, core);
3208369ae33SRafał Miłecki }
3218369ae33SRafał Miłecki
322d6a3b51aSRafał Miłecki #ifdef CONFIG_BCMA_PFLASH
32373e4dbe4SRafał Miłecki if (bus->drv_cc.pflash.present) {
32473e4dbe4SRafał Miłecki err = platform_device_register(&bcma_pflash_dev);
32573e4dbe4SRafał Miłecki if (err)
32673e4dbe4SRafał Miłecki bcma_err(bus, "Error registering parallel flash\n");
32773e4dbe4SRafał Miłecki }
32873e4dbe4SRafał Miłecki #endif
32973e4dbe4SRafał Miłecki
330d57ef3a6SRafał Miłecki #ifdef CONFIG_BCMA_SFLASH
331d57ef3a6SRafał Miłecki if (bus->drv_cc.sflash.present) {
332d57ef3a6SRafał Miłecki err = platform_device_register(&bcma_sflash_dev);
333d57ef3a6SRafał Miłecki if (err)
334d57ef3a6SRafał Miłecki bcma_err(bus, "Error registering serial flash\n");
335d57ef3a6SRafał Miłecki }
336d57ef3a6SRafał Miłecki #endif
337d57ef3a6SRafał Miłecki
338371a0044SRafał Miłecki #ifdef CONFIG_BCMA_NFLASH
339371a0044SRafał Miłecki if (bus->drv_cc.nflash.present) {
340371a0044SRafał Miłecki err = platform_device_register(&bcma_nflash_dev);
341371a0044SRafał Miłecki if (err)
342371a0044SRafał Miłecki bcma_err(bus, "Error registering NAND flash\n");
343371a0044SRafał Miłecki }
344371a0044SRafał Miłecki #endif
345cf0936b0SHauke Mehrtens err = bcma_gpio_init(&bus->drv_cc);
346cf0936b0SHauke Mehrtens if (err == -ENOTSUPP)
347cf0936b0SHauke Mehrtens bcma_debug(bus, "GPIO driver not activated\n");
34874a47300SLinus Walleij else if (err) {
349cf0936b0SHauke Mehrtens bcma_err(bus, "Error registering GPIO driver: %i\n", err);
35074a47300SLinus Walleij return err;
35174a47300SLinus Walleij }
352371a0044SRafał Miłecki
353a4855f39SHauke Mehrtens if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
354a4855f39SHauke Mehrtens err = bcma_chipco_watchdog_register(&bus->drv_cc);
355a4855f39SHauke Mehrtens if (err)
356a4855f39SHauke Mehrtens bcma_err(bus, "Error registering watchdog driver\n");
357a4855f39SHauke Mehrtens }
358a4855f39SHauke Mehrtens
3598369ae33SRafał Miłecki return 0;
3608369ae33SRafał Miłecki }
3618369ae33SRafał Miłecki
bcma_unregister_cores(struct bcma_bus * bus)3629b6cc9a8SRafał Miłecki void bcma_unregister_cores(struct bcma_bus *bus)
3638369ae33SRafał Miłecki {
3641fffa905SPiotr Haber struct bcma_device *core, *tmp;
3658369ae33SRafał Miłecki
3661fffa905SPiotr Haber list_for_each_entry_safe(core, tmp, &bus->cores, list) {
36717fbaa6eSRafał Miłecki if (!core->dev_registered)
36817fbaa6eSRafał Miłecki continue;
3691fffa905SPiotr Haber list_del(&core->list);
3708369ae33SRafał Miłecki device_unregister(&core->dev);
3718369ae33SRafał Miłecki }
372a4855f39SHauke Mehrtens if (bus->hosttype == BCMA_HOSTTYPE_SOC)
373a4855f39SHauke Mehrtens platform_device_unregister(bus->drv_cc.watchdog);
37417fbaa6eSRafał Miłecki
37517fbaa6eSRafał Miłecki /* Now no one uses internally-handled cores, we can free them */
37617fbaa6eSRafał Miłecki list_for_each_entry_safe(core, tmp, &bus->cores, list) {
37717fbaa6eSRafał Miłecki list_del(&core->list);
378b63aed3fSZenghui Yu put_device(&core->dev);
37917fbaa6eSRafał Miłecki }
3808369ae33SRafał Miłecki }
3818369ae33SRafał Miłecki
bcma_bus_register(struct bcma_bus * bus)3820f58a01dSGreg Kroah-Hartman int bcma_bus_register(struct bcma_bus *bus)
3838369ae33SRafał Miłecki {
3848369ae33SRafał Miłecki int err;
3858369ae33SRafał Miłecki struct bcma_device *core;
3868369ae33SRafał Miłecki
3878369ae33SRafał Miłecki /* Scan for devices (cores) */
3888369ae33SRafał Miłecki err = bcma_bus_scan(bus);
3898369ae33SRafał Miłecki if (err) {
3903d9d8af3SRafał Miłecki bcma_err(bus, "Failed to scan: %d\n", err);
3911cabf7dbSHauke Mehrtens return err;
3928369ae33SRafał Miłecki }
3938369ae33SRafał Miłecki
39430cfb023SHauke Mehrtens /* Early init CC core */
39530cfb023SHauke Mehrtens core = bcma_find_core(bus, bcma_cc_core_id(bus));
39630cfb023SHauke Mehrtens if (core) {
39730cfb023SHauke Mehrtens bus->drv_cc.core = core;
39830cfb023SHauke Mehrtens bcma_core_chipcommon_early_init(&bus->drv_cc);
39930cfb023SHauke Mehrtens }
40030cfb023SHauke Mehrtens
401b504075fSRafał Miłecki /* Early init PCIE core */
402b504075fSRafał Miłecki core = bcma_find_core(bus, BCMA_CORE_PCIE);
403b504075fSRafał Miłecki if (core) {
404b504075fSRafał Miłecki bus->drv_pci[0].core = core;
405b504075fSRafał Miłecki bcma_core_pci_early_init(&bus->drv_pci[0]);
406b504075fSRafał Miłecki }
407b504075fSRafał Miłecki
4085a1c18b7SRafał Miłecki if (bus->dev)
4095a1c18b7SRafał Miłecki of_platform_default_populate(bus->dev->of_node, NULL, bus->dev);
410cae761b5SRafał Miłecki
41137a7f876SRafał Miłecki /* Cores providing flash access go before SPROM init */
41237a7f876SRafał Miłecki list_for_each_entry(core, &bus->cores, list) {
41337a7f876SRafał Miłecki if (bcma_is_core_needed_early(core->id.id))
41437a7f876SRafał Miłecki bcma_register_core(bus, core);
41537a7f876SRafał Miłecki }
41637a7f876SRafał Miłecki
41730cfb023SHauke Mehrtens /* Try to get SPROM */
41830cfb023SHauke Mehrtens err = bcma_sprom_get(bus);
41930cfb023SHauke Mehrtens if (err == -ENOENT) {
42030cfb023SHauke Mehrtens bcma_err(bus, "No SPROM available\n");
42130cfb023SHauke Mehrtens } else if (err)
42230cfb023SHauke Mehrtens bcma_err(bus, "Failed to get SPROM: %d\n", err);
42330cfb023SHauke Mehrtens
4248369ae33SRafał Miłecki /* Init CC core */
4256d5cfc9fSRafał Miłecki core = bcma_find_core(bus, bcma_cc_core_id(bus));
4268369ae33SRafał Miłecki if (core) {
4278369ae33SRafał Miłecki bus->drv_cc.core = core;
4288369ae33SRafał Miłecki bcma_core_chipcommon_init(&bus->drv_cc);
4298369ae33SRafał Miłecki }
4308369ae33SRafał Miłecki
4311716bcf3SHauke Mehrtens /* Init CC core */
4321716bcf3SHauke Mehrtens core = bcma_find_core(bus, BCMA_CORE_NS_CHIPCOMMON_B);
4331716bcf3SHauke Mehrtens if (core) {
4341716bcf3SHauke Mehrtens bus->drv_cc_b.core = core;
4351716bcf3SHauke Mehrtens bcma_core_chipcommon_b_init(&bus->drv_cc_b);
4361716bcf3SHauke Mehrtens }
4371716bcf3SHauke Mehrtens
43821e0534aSHauke Mehrtens /* Init MIPS core */
43921e0534aSHauke Mehrtens core = bcma_find_core(bus, BCMA_CORE_MIPS_74K);
44021e0534aSHauke Mehrtens if (core) {
44121e0534aSHauke Mehrtens bus->drv_mips.core = core;
44221e0534aSHauke Mehrtens bcma_core_mips_init(&bus->drv_mips);
44321e0534aSHauke Mehrtens }
44421e0534aSHauke Mehrtens
4458369ae33SRafał Miłecki /* Init PCIE core */
446dfae7143SHauke Mehrtens core = bcma_find_core_unit(bus, BCMA_CORE_PCIE, 0);
4478369ae33SRafał Miłecki if (core) {
448dfae7143SHauke Mehrtens bus->drv_pci[0].core = core;
449dfae7143SHauke Mehrtens bcma_core_pci_init(&bus->drv_pci[0]);
450dfae7143SHauke Mehrtens }
451dfae7143SHauke Mehrtens
452dfae7143SHauke Mehrtens /* Init PCIE core */
453dfae7143SHauke Mehrtens core = bcma_find_core_unit(bus, BCMA_CORE_PCIE, 1);
454dfae7143SHauke Mehrtens if (core) {
455dfae7143SHauke Mehrtens bus->drv_pci[1].core = core;
456dfae7143SHauke Mehrtens bcma_core_pci_init(&bus->drv_pci[1]);
4578369ae33SRafał Miłecki }
4588369ae33SRafał Miłecki
459f473832fSRafał Miłecki /* Init PCIe Gen 2 core */
460f473832fSRafał Miłecki core = bcma_find_core_unit(bus, BCMA_CORE_PCIE2, 0);
461f473832fSRafał Miłecki if (core) {
462f473832fSRafał Miłecki bus->drv_pcie2.core = core;
463f473832fSRafał Miłecki bcma_core_pcie2_init(&bus->drv_pcie2);
464f473832fSRafał Miłecki }
465f473832fSRafał Miłecki
466e1ac4b40SRafał Miłecki /* Init GBIT MAC COMMON core */
467e1ac4b40SRafał Miłecki core = bcma_find_core(bus, BCMA_CORE_4706_MAC_GBIT_COMMON);
468e1ac4b40SRafał Miłecki if (core) {
469e1ac4b40SRafał Miłecki bus->drv_gmac_cmn.core = core;
470e1ac4b40SRafał Miłecki bcma_core_gmac_cmn_init(&bus->drv_gmac_cmn);
471e1ac4b40SRafał Miłecki }
472e1ac4b40SRafał Miłecki
4738369ae33SRafał Miłecki /* Register found cores */
4746e094bd8SRafał Miłecki bcma_register_devices(bus);
4758369ae33SRafał Miłecki
4763d9d8af3SRafał Miłecki bcma_info(bus, "Bus registered\n");
4778369ae33SRafał Miłecki
4788369ae33SRafał Miłecki return 0;
4798369ae33SRafał Miłecki }
4808369ae33SRafał Miłecki
bcma_bus_unregister(struct bcma_bus * bus)4818369ae33SRafał Miłecki void bcma_bus_unregister(struct bcma_bus *bus)
4828369ae33SRafał Miłecki {
483c50ae947SHauke Mehrtens int err;
484c50ae947SHauke Mehrtens
485c50ae947SHauke Mehrtens err = bcma_gpio_unregister(&bus->drv_cc);
486c50ae947SHauke Mehrtens if (err == -EBUSY)
487c50ae947SHauke Mehrtens bcma_err(bus, "Some GPIOs are still in use.\n");
488c50ae947SHauke Mehrtens else if (err)
489c50ae947SHauke Mehrtens bcma_err(bus, "Can not unregister GPIO driver: %i\n", err);
490ee915927SSaul St. John
4911716bcf3SHauke Mehrtens bcma_core_chipcommon_b_free(&bus->drv_cc_b);
4921716bcf3SHauke Mehrtens
4938369ae33SRafał Miłecki bcma_unregister_cores(bus);
4948369ae33SRafał Miłecki }
4958369ae33SRafał Miłecki
496c5ed1df7SRafał Miłecki /*
497c5ed1df7SRafał Miłecki * This is a special version of bus registration function designed for SoCs.
498c5ed1df7SRafał Miłecki * It scans bus and performs basic initialization of main cores only.
499c5ed1df7SRafał Miłecki * Please note it requires memory allocation, however it won't try to sleep.
500c5ed1df7SRafał Miłecki */
bcma_bus_early_register(struct bcma_bus * bus)501c5ed1df7SRafał Miłecki int __init bcma_bus_early_register(struct bcma_bus *bus)
502517f43e5SHauke Mehrtens {
503517f43e5SHauke Mehrtens int err;
504517f43e5SHauke Mehrtens struct bcma_device *core;
505517f43e5SHauke Mehrtens
506c5ed1df7SRafał Miłecki /* Scan for devices (cores) */
507c5ed1df7SRafał Miłecki err = bcma_bus_scan(bus);
508517f43e5SHauke Mehrtens if (err) {
509c5ed1df7SRafał Miłecki bcma_err(bus, "Failed to scan bus: %d\n", err);
510517f43e5SHauke Mehrtens return -1;
511517f43e5SHauke Mehrtens }
512517f43e5SHauke Mehrtens
51349655bb8SHauke Mehrtens /* Early init CC core */
5146d5cfc9fSRafał Miłecki core = bcma_find_core(bus, bcma_cc_core_id(bus));
515517f43e5SHauke Mehrtens if (core) {
516517f43e5SHauke Mehrtens bus->drv_cc.core = core;
51749655bb8SHauke Mehrtens bcma_core_chipcommon_early_init(&bus->drv_cc);
518517f43e5SHauke Mehrtens }
519517f43e5SHauke Mehrtens
52049655bb8SHauke Mehrtens /* Early init MIPS core */
52121e0534aSHauke Mehrtens core = bcma_find_core(bus, BCMA_CORE_MIPS_74K);
52221e0534aSHauke Mehrtens if (core) {
52321e0534aSHauke Mehrtens bus->drv_mips.core = core;
52449655bb8SHauke Mehrtens bcma_core_mips_early_init(&bus->drv_mips);
52521e0534aSHauke Mehrtens }
52621e0534aSHauke Mehrtens
5273d9d8af3SRafał Miłecki bcma_info(bus, "Early bus registered\n");
528517f43e5SHauke Mehrtens
529517f43e5SHauke Mehrtens return 0;
530517f43e5SHauke Mehrtens }
531517f43e5SHauke Mehrtens
532775ab521SRafał Miłecki #ifdef CONFIG_PM
bcma_bus_suspend(struct bcma_bus * bus)533685a4ef0SLinus Torvalds int bcma_bus_suspend(struct bcma_bus *bus)
534685a4ef0SLinus Torvalds {
5357d5869e7SLinus Torvalds struct bcma_device *core;
5367d5869e7SLinus Torvalds
5377d5869e7SLinus Torvalds list_for_each_entry(core, &bus->cores, list) {
5387d5869e7SLinus Torvalds struct device_driver *drv = core->dev.driver;
5397d5869e7SLinus Torvalds if (drv) {
5407d5869e7SLinus Torvalds struct bcma_driver *adrv = container_of(drv, struct bcma_driver, drv);
5417d5869e7SLinus Torvalds if (adrv->suspend)
5427d5869e7SLinus Torvalds adrv->suspend(core);
5437d5869e7SLinus Torvalds }
5447d5869e7SLinus Torvalds }
545685a4ef0SLinus Torvalds return 0;
546685a4ef0SLinus Torvalds }
547685a4ef0SLinus Torvalds
bcma_bus_resume(struct bcma_bus * bus)548775ab521SRafał Miłecki int bcma_bus_resume(struct bcma_bus *bus)
549775ab521SRafał Miłecki {
550775ab521SRafał Miłecki struct bcma_device *core;
551775ab521SRafał Miłecki
552775ab521SRafał Miłecki /* Init CC core */
5536d5cfc9fSRafał Miłecki if (bus->drv_cc.core) {
554775ab521SRafał Miłecki bus->drv_cc.setup_done = false;
555775ab521SRafał Miłecki bcma_core_chipcommon_init(&bus->drv_cc);
556775ab521SRafał Miłecki }
557775ab521SRafał Miłecki
5587d5869e7SLinus Torvalds list_for_each_entry(core, &bus->cores, list) {
5597d5869e7SLinus Torvalds struct device_driver *drv = core->dev.driver;
5607d5869e7SLinus Torvalds if (drv) {
5617d5869e7SLinus Torvalds struct bcma_driver *adrv = container_of(drv, struct bcma_driver, drv);
5627d5869e7SLinus Torvalds if (adrv->resume)
5637d5869e7SLinus Torvalds adrv->resume(core);
5647d5869e7SLinus Torvalds }
5657d5869e7SLinus Torvalds }
5667d5869e7SLinus Torvalds
567775ab521SRafał Miłecki return 0;
568775ab521SRafał Miłecki }
569775ab521SRafał Miłecki #endif
570775ab521SRafał Miłecki
__bcma_driver_register(struct bcma_driver * drv,struct module * owner)5718369ae33SRafał Miłecki int __bcma_driver_register(struct bcma_driver *drv, struct module *owner)
5728369ae33SRafał Miłecki {
5738369ae33SRafał Miłecki drv->drv.name = drv->name;
5748369ae33SRafał Miłecki drv->drv.bus = &bcma_bus_type;
5758369ae33SRafał Miłecki drv->drv.owner = owner;
5768369ae33SRafał Miłecki
5778369ae33SRafał Miłecki return driver_register(&drv->drv);
5788369ae33SRafał Miłecki }
5798369ae33SRafał Miłecki EXPORT_SYMBOL_GPL(__bcma_driver_register);
5808369ae33SRafał Miłecki
bcma_driver_unregister(struct bcma_driver * drv)5818369ae33SRafał Miłecki void bcma_driver_unregister(struct bcma_driver *drv)
5828369ae33SRafał Miłecki {
5838369ae33SRafał Miłecki driver_unregister(&drv->drv);
5848369ae33SRafał Miłecki }
5858369ae33SRafał Miłecki EXPORT_SYMBOL_GPL(bcma_driver_unregister);
5868369ae33SRafał Miłecki
bcma_bus_match(struct device * dev,struct device_driver * drv)5878369ae33SRafał Miłecki static int bcma_bus_match(struct device *dev, struct device_driver *drv)
5888369ae33SRafał Miłecki {
5898369ae33SRafał Miłecki struct bcma_device *core = container_of(dev, struct bcma_device, dev);
5908369ae33SRafał Miłecki struct bcma_driver *adrv = container_of(drv, struct bcma_driver, drv);
5918369ae33SRafał Miłecki const struct bcma_device_id *cid = &core->id;
5928369ae33SRafał Miłecki const struct bcma_device_id *did;
5938369ae33SRafał Miłecki
5948369ae33SRafał Miłecki for (did = adrv->id_table; did->manuf || did->id || did->rev; did++) {
5958369ae33SRafał Miłecki if ((did->manuf == cid->manuf || did->manuf == BCMA_ANY_MANUF) &&
5968369ae33SRafał Miłecki (did->id == cid->id || did->id == BCMA_ANY_ID) &&
5978369ae33SRafał Miłecki (did->rev == cid->rev || did->rev == BCMA_ANY_REV) &&
5988369ae33SRafał Miłecki (did->class == cid->class || did->class == BCMA_ANY_CLASS))
5998369ae33SRafał Miłecki return 1;
6008369ae33SRafał Miłecki }
6018369ae33SRafał Miłecki return 0;
6028369ae33SRafał Miłecki }
6038369ae33SRafał Miłecki
bcma_device_probe(struct device * dev)6048369ae33SRafał Miłecki static int bcma_device_probe(struct device *dev)
6058369ae33SRafał Miłecki {
6068369ae33SRafał Miłecki struct bcma_device *core = container_of(dev, struct bcma_device, dev);
6078369ae33SRafał Miłecki struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver,
6088369ae33SRafał Miłecki drv);
6098369ae33SRafał Miłecki int err = 0;
6108369ae33SRafał Miłecki
611a971df0bSRafał Miłecki get_device(dev);
6128369ae33SRafał Miłecki if (adrv->probe)
6138369ae33SRafał Miłecki err = adrv->probe(core);
614a971df0bSRafał Miłecki if (err)
615a971df0bSRafał Miłecki put_device(dev);
6168369ae33SRafał Miłecki
6178369ae33SRafał Miłecki return err;
6188369ae33SRafał Miłecki }
6198369ae33SRafał Miłecki
bcma_device_remove(struct device * dev)620fc7a6209SUwe Kleine-König static void bcma_device_remove(struct device *dev)
6218369ae33SRafał Miłecki {
6228369ae33SRafał Miłecki struct bcma_device *core = container_of(dev, struct bcma_device, dev);
6238369ae33SRafał Miłecki struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver,
6248369ae33SRafał Miłecki drv);
6258369ae33SRafał Miłecki
6268369ae33SRafał Miłecki if (adrv->remove)
6278369ae33SRafał Miłecki adrv->remove(core);
628a971df0bSRafał Miłecki put_device(dev);
6298369ae33SRafał Miłecki }
6308369ae33SRafał Miłecki
bcma_device_uevent(const struct device * dev,struct kobj_uevent_env * env)6312a81ada3SGreg Kroah-Hartman static int bcma_device_uevent(const struct device *dev, struct kobj_uevent_env *env)
632886b66efSDavid Woodhouse {
6332a81ada3SGreg Kroah-Hartman const struct bcma_device *core = container_of_const(dev, struct bcma_device, dev);
634886b66efSDavid Woodhouse
635886b66efSDavid Woodhouse return add_uevent_var(env,
636886b66efSDavid Woodhouse "MODALIAS=bcma:m%04Xid%04Xrev%02Xcl%02X",
637886b66efSDavid Woodhouse core->id.manuf, core->id.id,
638886b66efSDavid Woodhouse core->id.rev, core->id.class);
639886b66efSDavid Woodhouse }
640886b66efSDavid Woodhouse
6410510931eSRafał Miłecki static unsigned int bcma_bus_registered;
6420510931eSRafał Miłecki
6430510931eSRafał Miłecki /*
6440510931eSRafał Miłecki * If built-in, bus has to be registered early, before any driver calls
6450510931eSRafał Miłecki * bcma_driver_register.
6460510931eSRafał Miłecki * Otherwise registering driver would trigger BUG in driver_register.
6470510931eSRafał Miłecki */
bcma_init_bus_register(void)6480510931eSRafał Miłecki static int __init bcma_init_bus_register(void)
6490510931eSRafał Miłecki {
6500510931eSRafał Miłecki int err;
6510510931eSRafał Miłecki
6520510931eSRafał Miłecki if (bcma_bus_registered)
6530510931eSRafał Miłecki return 0;
6540510931eSRafał Miłecki
6550510931eSRafał Miłecki err = bus_register(&bcma_bus_type);
6560510931eSRafał Miłecki if (!err)
6570510931eSRafał Miłecki bcma_bus_registered = 1;
6580510931eSRafał Miłecki
6590510931eSRafał Miłecki return err;
6600510931eSRafał Miłecki }
6610510931eSRafał Miłecki #ifndef MODULE
6620510931eSRafał Miłecki fs_initcall(bcma_init_bus_register);
6630510931eSRafał Miłecki #endif
6640510931eSRafał Miłecki
6650510931eSRafał Miłecki /* Main initialization has to be done with SPI/mtd/NAND/SPROM available */
bcma_modinit(void)6668369ae33SRafał Miłecki static int __init bcma_modinit(void)
6678369ae33SRafał Miłecki {
6688369ae33SRafał Miłecki int err;
6698369ae33SRafał Miłecki
6700510931eSRafał Miłecki err = bcma_init_bus_register();
6718369ae33SRafał Miłecki if (err)
6728369ae33SRafał Miłecki return err;
6738369ae33SRafał Miłecki
6742101e533SHauke Mehrtens err = bcma_host_soc_register_driver();
6752101e533SHauke Mehrtens if (err) {
6762101e533SHauke Mehrtens pr_err("SoC host initialization failed\n");
6772101e533SHauke Mehrtens err = 0;
6782101e533SHauke Mehrtens }
6798369ae33SRafał Miłecki #ifdef CONFIG_BCMA_HOST_PCI
6808369ae33SRafał Miłecki err = bcma_host_pci_init();
6818369ae33SRafał Miłecki if (err) {
6828369ae33SRafał Miłecki pr_err("PCI host initialization failed\n");
6838369ae33SRafał Miłecki err = 0;
6848369ae33SRafał Miłecki }
6858369ae33SRafał Miłecki #endif
6868369ae33SRafał Miłecki
6878369ae33SRafał Miłecki return err;
6888369ae33SRafał Miłecki }
6890510931eSRafał Miłecki module_init(bcma_modinit);
6908369ae33SRafał Miłecki
bcma_modexit(void)6918369ae33SRafał Miłecki static void __exit bcma_modexit(void)
6928369ae33SRafał Miłecki {
6938369ae33SRafał Miłecki #ifdef CONFIG_BCMA_HOST_PCI
6948369ae33SRafał Miłecki bcma_host_pci_exit();
6958369ae33SRafał Miłecki #endif
6962101e533SHauke Mehrtens bcma_host_soc_unregister_driver();
6978369ae33SRafał Miłecki bus_unregister(&bcma_bus_type);
6988369ae33SRafał Miłecki }
6998369ae33SRafał Miłecki module_exit(bcma_modexit)
700