main.c revision 1bdcd095e39a789135f8638a2ff76f74e3071d46 
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/bcma/bcma.h>
10
11MODULE_DESCRIPTION("Broadcom's specific AMBA driver");
12MODULE_LICENSE("GPL");
13
14static int bcma_bus_match(struct device *dev, struct device_driver *drv);
15static int bcma_device_probe(struct device *dev);
16static int bcma_device_remove(struct device *dev);
17
18static ssize_t manuf_show(struct device *dev, struct device_attribute *attr, char *buf)
19{
20	struct bcma_device *core = container_of(dev, struct bcma_device, dev);
21	return sprintf(buf, "0x%03X\n", core->id.manuf);
22}
23static ssize_t id_show(struct device *dev, struct device_attribute *attr, char *buf)
24{
25	struct bcma_device *core = container_of(dev, struct bcma_device, dev);
26	return sprintf(buf, "0x%03X\n", core->id.id);
27}
28static ssize_t rev_show(struct device *dev, struct device_attribute *attr, char *buf)
29{
30	struct bcma_device *core = container_of(dev, struct bcma_device, dev);
31	return sprintf(buf, "0x%02X\n", core->id.rev);
32}
33static ssize_t class_show(struct device *dev, struct device_attribute *attr, char *buf)
34{
35	struct bcma_device *core = container_of(dev, struct bcma_device, dev);
36	return sprintf(buf, "0x%X\n", core->id.class);
37}
38static struct device_attribute bcma_device_attrs[] = {
39	__ATTR_RO(manuf),
40	__ATTR_RO(id),
41	__ATTR_RO(rev),
42	__ATTR_RO(class),
43	__ATTR_NULL,
44};
45
46static struct bus_type bcma_bus_type = {
47	.name		= "bcma",
48	.match		= bcma_bus_match,
49	.probe		= bcma_device_probe,
50	.remove		= bcma_device_remove,
51	.dev_attrs	= bcma_device_attrs,
52};
53
54static struct bcma_device *bcma_find_core(struct bcma_bus *bus, u16 coreid)
55{
56	struct bcma_device *core;
57
58	list_for_each_entry(core, &bus->cores, list) {
59		if (core->id.id == coreid)
60			return core;
61	}
62	return NULL;
63}
64
65static void bcma_release_core_dev(struct device *dev)
66{
67	struct bcma_device *core = container_of(dev, struct bcma_device, dev);
68	kfree(core);
69}
70
71static int bcma_register_cores(struct bcma_bus *bus)
72{
73	struct bcma_device *core;
74	int err, dev_id = 0;
75
76	list_for_each_entry(core, &bus->cores, list) {
77		/* We support that cores ourself */
78		switch (core->id.id) {
79		case BCMA_CORE_CHIPCOMMON:
80		case BCMA_CORE_PCI:
81		case BCMA_CORE_PCIE:
82			continue;
83		}
84
85		core->dev.release = bcma_release_core_dev;
86		core->dev.bus = &bcma_bus_type;
87		dev_set_name(&core->dev, "bcma%d:%d", 0/*bus->num*/, dev_id);
88
89		switch (bus->hosttype) {
90		case BCMA_HOSTTYPE_PCI:
91			core->dev.parent = &bus->host_pci->dev;
92			core->dma_dev = &bus->host_pci->dev;
93			core->irq = bus->host_pci->irq;
94			break;
95		case BCMA_HOSTTYPE_NONE:
96		case BCMA_HOSTTYPE_SDIO:
97			break;
98		}
99
100		err = device_register(&core->dev);
101		if (err) {
102			pr_err("Could not register dev for core 0x%03X\n",
103			       core->id.id);
104			continue;
105		}
106		core->dev_registered = true;
107		dev_id++;
108	}
109
110	return 0;
111}
112
113static void bcma_unregister_cores(struct bcma_bus *bus)
114{
115	struct bcma_device *core;
116
117	list_for_each_entry(core, &bus->cores, list) {
118		if (core->dev_registered)
119			device_unregister(&core->dev);
120	}
121}
122
123int bcma_bus_register(struct bcma_bus *bus)
124{
125	int err;
126	struct bcma_device *core;
127
128	/* Scan for devices (cores) */
129	err = bcma_bus_scan(bus);
130	if (err) {
131		pr_err("Failed to scan: %d\n", err);
132		return -1;
133	}
134
135	/* Init CC core */
136	core = bcma_find_core(bus, BCMA_CORE_CHIPCOMMON);
137	if (core) {
138		bus->drv_cc.core = core;
139		bcma_core_chipcommon_init(&bus->drv_cc);
140	}
141
142	/* Init PCIE core */
143	core = bcma_find_core(bus, BCMA_CORE_PCIE);
144	if (core) {
145		bus->drv_pci.core = core;
146		bcma_core_pci_init(&bus->drv_pci);
147	}
148
149	/* Register found cores */
150	bcma_register_cores(bus);
151
152	pr_info("Bus registered\n");
153
154	return 0;
155}
156EXPORT_SYMBOL_GPL(bcma_bus_register);
157
158void bcma_bus_unregister(struct bcma_bus *bus)
159{
160	bcma_unregister_cores(bus);
161}
162EXPORT_SYMBOL_GPL(bcma_bus_unregister);
163
164int __bcma_driver_register(struct bcma_driver *drv, struct module *owner)
165{
166	drv->drv.name = drv->name;
167	drv->drv.bus = &bcma_bus_type;
168	drv->drv.owner = owner;
169
170	return driver_register(&drv->drv);
171}
172EXPORT_SYMBOL_GPL(__bcma_driver_register);
173
174void bcma_driver_unregister(struct bcma_driver *drv)
175{
176	driver_unregister(&drv->drv);
177}
178EXPORT_SYMBOL_GPL(bcma_driver_unregister);
179
180static int bcma_bus_match(struct device *dev, struct device_driver *drv)
181{
182	struct bcma_device *core = container_of(dev, struct bcma_device, dev);
183	struct bcma_driver *adrv = container_of(drv, struct bcma_driver, drv);
184	const struct bcma_device_id *cid = &core->id;
185	const struct bcma_device_id *did;
186
187	for (did = adrv->id_table; did->manuf || did->id || did->rev; did++) {
188	    if ((did->manuf == cid->manuf || did->manuf == BCMA_ANY_MANUF) &&
189		(did->id == cid->id || did->id == BCMA_ANY_ID) &&
190		(did->rev == cid->rev || did->rev == BCMA_ANY_REV) &&
191		(did->class == cid->class || did->class == BCMA_ANY_CLASS))
192			return 1;
193	}
194	return 0;
195}
196
197static int bcma_device_probe(struct device *dev)
198{
199	struct bcma_device *core = container_of(dev, struct bcma_device, dev);
200	struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver,
201					       drv);
202	int err = 0;
203
204	if (adrv->probe)
205		err = adrv->probe(core);
206
207	return err;
208}
209
210static int bcma_device_remove(struct device *dev)
211{
212	struct bcma_device *core = container_of(dev, struct bcma_device, dev);
213	struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver,
214					       drv);
215
216	if (adrv->remove)
217		adrv->remove(core);
218
219	return 0;
220}
221
222static int __init bcma_modinit(void)
223{
224	int err;
225
226	err = bus_register(&bcma_bus_type);
227	if (err)
228		return err;
229
230#ifdef CONFIG_BCMA_HOST_PCI
231	err = bcma_host_pci_init();
232	if (err) {
233		pr_err("PCI host initialization failed\n");
234		err = 0;
235	}
236#endif
237
238	return err;
239}
240fs_initcall(bcma_modinit);
241
242static void __exit bcma_modexit(void)
243{
244#ifdef CONFIG_BCMA_HOST_PCI
245	bcma_host_pci_exit();
246#endif
247	bus_unregister(&bcma_bus_type);
248}
249module_exit(bcma_modexit)
250