blob: 70c84b95109860205a7ec1d216ef8df58f34ba30 [file] [log] [blame]
Rafał Miłecki8369ae32011-05-09 18:56:46 +02001/*
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"
Paul Gortmaker200351c2011-07-01 16:06:37 -04009#include <linux/module.h>
Rafał Miłecki8369ae32011-05-09 18:56:46 +020010#include <linux/bcma/bcma.h>
Geert Uytterhoeveneef72692011-06-26 10:19:44 +020011#include <linux/slab.h>
Rafał Miłecki8369ae32011-05-09 18:56:46 +020012
13MODULE_DESCRIPTION("Broadcom's specific AMBA driver");
14MODULE_LICENSE("GPL");
15
16static int bcma_bus_match(struct device *dev, struct device_driver *drv);
17static int bcma_device_probe(struct device *dev);
18static int bcma_device_remove(struct device *dev);
David Woodhouse886b66e2011-08-19 22:14:47 +020019static int bcma_device_uevent(struct device *dev, struct kobj_uevent_env *env);
Rafał Miłecki8369ae32011-05-09 18:56:46 +020020
21static ssize_t manuf_show(struct device *dev, struct device_attribute *attr, char *buf)
22{
23 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
24 return sprintf(buf, "0x%03X\n", core->id.manuf);
25}
26static ssize_t id_show(struct device *dev, struct device_attribute *attr, char *buf)
27{
28 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
29 return sprintf(buf, "0x%03X\n", core->id.id);
30}
31static ssize_t rev_show(struct device *dev, struct device_attribute *attr, char *buf)
32{
33 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
34 return sprintf(buf, "0x%02X\n", core->id.rev);
35}
36static ssize_t class_show(struct device *dev, struct device_attribute *attr, char *buf)
37{
38 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
39 return sprintf(buf, "0x%X\n", core->id.class);
40}
41static struct device_attribute bcma_device_attrs[] = {
42 __ATTR_RO(manuf),
43 __ATTR_RO(id),
44 __ATTR_RO(rev),
45 __ATTR_RO(class),
46 __ATTR_NULL,
47};
48
49static struct bus_type bcma_bus_type = {
50 .name = "bcma",
51 .match = bcma_bus_match,
52 .probe = bcma_device_probe,
53 .remove = bcma_device_remove,
David Woodhouse886b66e2011-08-19 22:14:47 +020054 .uevent = bcma_device_uevent,
Rafał Miłecki8369ae32011-05-09 18:56:46 +020055 .dev_attrs = bcma_device_attrs,
56};
57
58static struct bcma_device *bcma_find_core(struct bcma_bus *bus, u16 coreid)
59{
60 struct bcma_device *core;
61
62 list_for_each_entry(core, &bus->cores, list) {
63 if (core->id.id == coreid)
64 return core;
65 }
66 return NULL;
67}
68
69static void bcma_release_core_dev(struct device *dev)
70{
71 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
Hauke Mehrtensecd177c2011-07-23 01:20:08 +020072 if (core->io_addr)
73 iounmap(core->io_addr);
74 if (core->io_wrap)
75 iounmap(core->io_wrap);
Rafał Miłecki8369ae32011-05-09 18:56:46 +020076 kfree(core);
77}
78
79static int bcma_register_cores(struct bcma_bus *bus)
80{
81 struct bcma_device *core;
82 int err, dev_id = 0;
83
84 list_for_each_entry(core, &bus->cores, list) {
85 /* We support that cores ourself */
86 switch (core->id.id) {
87 case BCMA_CORE_CHIPCOMMON:
88 case BCMA_CORE_PCI:
89 case BCMA_CORE_PCIE:
Hauke Mehrtens21e05342011-07-23 01:20:09 +020090 case BCMA_CORE_MIPS_74K:
Rafał Miłecki8369ae32011-05-09 18:56:46 +020091 continue;
92 }
93
94 core->dev.release = bcma_release_core_dev;
95 core->dev.bus = &bcma_bus_type;
96 dev_set_name(&core->dev, "bcma%d:%d", 0/*bus->num*/, dev_id);
97
98 switch (bus->hosttype) {
99 case BCMA_HOSTTYPE_PCI:
100 core->dev.parent = &bus->host_pci->dev;
Rafał Miłecki1bdcd092011-05-18 11:40:22 +0200101 core->dma_dev = &bus->host_pci->dev;
102 core->irq = bus->host_pci->irq;
Rafał Miłecki8369ae32011-05-09 18:56:46 +0200103 break;
Hauke Mehrtensecd177c2011-07-23 01:20:08 +0200104 case BCMA_HOSTTYPE_SOC:
105 core->dev.dma_mask = &core->dev.coherent_dma_mask;
106 core->dma_dev = &core->dev;
107 break;
Rafał Miłecki8369ae32011-05-09 18:56:46 +0200108 case BCMA_HOSTTYPE_SDIO:
109 break;
110 }
111
112 err = device_register(&core->dev);
113 if (err) {
114 pr_err("Could not register dev for core 0x%03X\n",
115 core->id.id);
116 continue;
117 }
118 core->dev_registered = true;
119 dev_id++;
120 }
121
122 return 0;
123}
124
125static void bcma_unregister_cores(struct bcma_bus *bus)
126{
127 struct bcma_device *core;
128
129 list_for_each_entry(core, &bus->cores, list) {
130 if (core->dev_registered)
131 device_unregister(&core->dev);
132 }
133}
134
135int bcma_bus_register(struct bcma_bus *bus)
136{
137 int err;
138 struct bcma_device *core;
139
140 /* Scan for devices (cores) */
141 err = bcma_bus_scan(bus);
142 if (err) {
143 pr_err("Failed to scan: %d\n", err);
144 return -1;
145 }
146
147 /* Init CC core */
148 core = bcma_find_core(bus, BCMA_CORE_CHIPCOMMON);
149 if (core) {
150 bus->drv_cc.core = core;
151 bcma_core_chipcommon_init(&bus->drv_cc);
152 }
153
Hauke Mehrtens21e05342011-07-23 01:20:09 +0200154 /* Init MIPS core */
155 core = bcma_find_core(bus, BCMA_CORE_MIPS_74K);
156 if (core) {
157 bus->drv_mips.core = core;
158 bcma_core_mips_init(&bus->drv_mips);
159 }
160
Rafał Miłecki8369ae32011-05-09 18:56:46 +0200161 /* Init PCIE core */
162 core = bcma_find_core(bus, BCMA_CORE_PCIE);
163 if (core) {
164 bus->drv_pci.core = core;
165 bcma_core_pci_init(&bus->drv_pci);
166 }
167
Rafał Miłecki27f18dc2011-06-02 02:08:51 +0200168 /* Try to get SPROM */
169 err = bcma_sprom_get(bus);
Hauke Mehrtens534e7a42011-07-09 13:22:03 +0200170 if (err == -ENOENT) {
171 pr_err("No SPROM available\n");
172 } else if (err) {
Rafał Miłecki27f18dc2011-06-02 02:08:51 +0200173 pr_err("Failed to get SPROM: %d\n", err);
174 return -ENOENT;
175 }
176
Rafał Miłecki8369ae32011-05-09 18:56:46 +0200177 /* Register found cores */
178 bcma_register_cores(bus);
179
180 pr_info("Bus registered\n");
181
182 return 0;
183}
Rafał Miłecki8369ae32011-05-09 18:56:46 +0200184
185void bcma_bus_unregister(struct bcma_bus *bus)
186{
187 bcma_unregister_cores(bus);
188}
Rafał Miłecki8369ae32011-05-09 18:56:46 +0200189
Hauke Mehrtens517f43e2011-07-23 01:20:07 +0200190int __init bcma_bus_early_register(struct bcma_bus *bus,
191 struct bcma_device *core_cc,
192 struct bcma_device *core_mips)
193{
194 int err;
195 struct bcma_device *core;
196 struct bcma_device_id match;
197
198 bcma_init_bus(bus);
199
200 match.manuf = BCMA_MANUF_BCM;
201 match.id = BCMA_CORE_CHIPCOMMON;
202 match.class = BCMA_CL_SIM;
203 match.rev = BCMA_ANY_REV;
204
205 /* Scan for chip common core */
206 err = bcma_bus_scan_early(bus, &match, core_cc);
207 if (err) {
208 pr_err("Failed to scan for common core: %d\n", err);
209 return -1;
210 }
211
212 match.manuf = BCMA_MANUF_MIPS;
213 match.id = BCMA_CORE_MIPS_74K;
214 match.class = BCMA_CL_SIM;
215 match.rev = BCMA_ANY_REV;
216
217 /* Scan for mips core */
218 err = bcma_bus_scan_early(bus, &match, core_mips);
219 if (err) {
220 pr_err("Failed to scan for mips core: %d\n", err);
221 return -1;
222 }
223
224 /* Init CC core */
225 core = bcma_find_core(bus, BCMA_CORE_CHIPCOMMON);
226 if (core) {
227 bus->drv_cc.core = core;
228 bcma_core_chipcommon_init(&bus->drv_cc);
229 }
230
Hauke Mehrtens21e05342011-07-23 01:20:09 +0200231 /* Init MIPS core */
232 core = bcma_find_core(bus, BCMA_CORE_MIPS_74K);
233 if (core) {
234 bus->drv_mips.core = core;
235 bcma_core_mips_init(&bus->drv_mips);
236 }
237
Hauke Mehrtens517f43e2011-07-23 01:20:07 +0200238 pr_info("Early bus registered\n");
239
240 return 0;
241}
242
Rafał Miłecki8369ae32011-05-09 18:56:46 +0200243int __bcma_driver_register(struct bcma_driver *drv, struct module *owner)
244{
245 drv->drv.name = drv->name;
246 drv->drv.bus = &bcma_bus_type;
247 drv->drv.owner = owner;
248
249 return driver_register(&drv->drv);
250}
251EXPORT_SYMBOL_GPL(__bcma_driver_register);
252
253void bcma_driver_unregister(struct bcma_driver *drv)
254{
255 driver_unregister(&drv->drv);
256}
257EXPORT_SYMBOL_GPL(bcma_driver_unregister);
258
259static int bcma_bus_match(struct device *dev, struct device_driver *drv)
260{
261 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
262 struct bcma_driver *adrv = container_of(drv, struct bcma_driver, drv);
263 const struct bcma_device_id *cid = &core->id;
264 const struct bcma_device_id *did;
265
266 for (did = adrv->id_table; did->manuf || did->id || did->rev; did++) {
267 if ((did->manuf == cid->manuf || did->manuf == BCMA_ANY_MANUF) &&
268 (did->id == cid->id || did->id == BCMA_ANY_ID) &&
269 (did->rev == cid->rev || did->rev == BCMA_ANY_REV) &&
270 (did->class == cid->class || did->class == BCMA_ANY_CLASS))
271 return 1;
272 }
273 return 0;
274}
275
276static int bcma_device_probe(struct device *dev)
277{
278 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
279 struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver,
280 drv);
281 int err = 0;
282
283 if (adrv->probe)
284 err = adrv->probe(core);
285
286 return err;
287}
288
289static int bcma_device_remove(struct device *dev)
290{
291 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
292 struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver,
293 drv);
294
295 if (adrv->remove)
296 adrv->remove(core);
297
298 return 0;
299}
300
David Woodhouse886b66e2011-08-19 22:14:47 +0200301static int bcma_device_uevent(struct device *dev, struct kobj_uevent_env *env)
302{
303 struct bcma_device *core = container_of(dev, struct bcma_device, dev);
304
305 return add_uevent_var(env,
306 "MODALIAS=bcma:m%04Xid%04Xrev%02Xcl%02X",
307 core->id.manuf, core->id.id,
308 core->id.rev, core->id.class);
309}
310
Rafał Miłecki8369ae32011-05-09 18:56:46 +0200311static int __init bcma_modinit(void)
312{
313 int err;
314
315 err = bus_register(&bcma_bus_type);
316 if (err)
317 return err;
318
319#ifdef CONFIG_BCMA_HOST_PCI
320 err = bcma_host_pci_init();
321 if (err) {
322 pr_err("PCI host initialization failed\n");
323 err = 0;
324 }
325#endif
326
327 return err;
328}
329fs_initcall(bcma_modinit);
330
331static void __exit bcma_modexit(void)
332{
333#ifdef CONFIG_BCMA_HOST_PCI
334 bcma_host_pci_exit();
335#endif
336 bus_unregister(&bcma_bus_type);
337}
338module_exit(bcma_modexit)