xref: /linux/drivers/bcma/main.c (revision a1ff5a7d78a036d6c2178ee5acd6ba4946243800)
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 
manuf_show(struct device * dev,struct device_attribute * attr,char * buf)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 
id_show(struct device * dev,struct device_attribute * attr,char * buf)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 
rev_show(struct device * dev,struct device_attribute * attr,char * buf)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 
class_show(struct device * dev,struct device_attribute * attr,char * buf)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 
bcma_cc_core_id(struct bcma_bus * bus)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 
bcma_find_core_unit(struct bcma_bus * bus,u16 coreid,u8 unit)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 
bcma_wait_value(struct bcma_device * core,u16 reg,u32 mask,u32 value,int timeout)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 
bcma_release_core_dev(struct device * dev)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 
bcma_is_core_needed_early(u16 core_id)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 
bcma_of_find_child_device(struct device * parent,struct bcma_device * core)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 
bcma_of_irq_parse(struct device * parent,struct bcma_device * core,struct of_phandle_args * out_irq,int num)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 
bcma_of_get_irq(struct device * parent,struct bcma_device * core,int num)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 
bcma_of_fill_device(struct device * parent,struct bcma_device * core)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 
bcma_core_irq(struct bcma_device * core,int num)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 
bcma_prepare_core(struct bcma_bus * bus,struct bcma_device * core)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 
bcma_init_bus(struct bcma_bus * bus)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 
bcma_register_core(struct bcma_bus * bus,struct bcma_device * core)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 
bcma_register_devices(struct bcma_bus * bus)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 
bcma_unregister_cores(struct bcma_bus * bus)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 
bcma_bus_register(struct bcma_bus * bus)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 
bcma_bus_unregister(struct bcma_bus * bus)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  */
bcma_bus_early_register(struct bcma_bus * bus)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
bcma_bus_suspend(struct bcma_bus * bus)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 
bcma_bus_resume(struct bcma_bus * bus)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 
__bcma_driver_register(struct bcma_driver * drv,struct module * owner)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 
bcma_driver_unregister(struct bcma_driver * drv)581 void bcma_driver_unregister(struct bcma_driver *drv)
582 {
583 	driver_unregister(&drv->drv);
584 }
585 EXPORT_SYMBOL_GPL(bcma_driver_unregister);
586 
bcma_bus_match(struct device * dev,const struct device_driver * drv)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 
bcma_device_probe(struct device * dev)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 
bcma_device_remove(struct device * dev)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 
bcma_device_uevent(const struct device * dev,struct kobj_uevent_env * env)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  */
bcma_init_bus_register(void)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 */
bcma_modinit(void)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 
bcma_modexit(void)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)
700