projects / openwrt.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
history | raw | HEAD
kernel: update ssb and bcma to linux-next next-20110627
[openwrt.git] / target / linux / generic / patches-2.6.39 / 025-bcma_backport.patch
1 --- /dev/null
2 +++ b/Documentation/ABI/testing/sysfs-bus-bcma
3 @@ -0,0 +1,31 @@
4 +What: /sys/bus/bcma/devices/.../manuf
5 +Date: May 2011
6 +KernelVersion: 2.6.40
7 +Contact: Rafał Miłecki <zajec5@gmail.com>
8 +Description:
9 + Each BCMA core has it's manufacturer id. See
10 + include/linux/bcma/bcma.h for possible values.
11 +
12 +What: /sys/bus/bcma/devices/.../id
13 +Date: May 2011
14 +KernelVersion: 2.6.40
15 +Contact: Rafał Miłecki <zajec5@gmail.com>
16 +Description:
17 + There are a few types of BCMA cores, they can be identified by
18 + id field.
19 +
20 +What: /sys/bus/bcma/devices/.../rev
21 +Date: May 2011
22 +KernelVersion: 2.6.40
23 +Contact: Rafał Miłecki <zajec5@gmail.com>
24 +Description:
25 + BCMA cores of the same type can still slightly differ depending
26 + on their revision. Use it for detailed programming.
27 +
28 +What: /sys/bus/bcma/devices/.../class
29 +Date: May 2011
30 +KernelVersion: 2.6.40
31 +Contact: Rafał Miłecki <zajec5@gmail.com>
32 +Description:
33 + Each BCMA core is identified by few fields, including class it
34 + belongs to. See include/linux/bcma/bcma.h for possible values.
35 --- a/MAINTAINERS
36 +++ b/MAINTAINERS
37 @@ -5832,6 +5832,13 @@ S: Maintained
38 F: drivers/ssb/
39 F: include/linux/ssb/
40
41 +BROADCOM SPECIFIC AMBA DRIVER (BCMA)
42 +M: Rafał Miłecki <zajec5@gmail.com>
43 +L: linux-wireless@vger.kernel.org
44 +S: Maintained
45 +F: drivers/bcma/
46 +F: include/linux/bcma/
47 +
48 SONY VAIO CONTROL DEVICE DRIVER
49 M: Mattia Dongili <malattia@linux.it>
50 L: platform-driver-x86@vger.kernel.org
51 --- a/drivers/Kconfig
52 +++ b/drivers/Kconfig
53 @@ -68,6 +68,8 @@ source "drivers/watchdog/Kconfig"
54
55 source "drivers/ssb/Kconfig"
56
57 +source "drivers/bcma/Kconfig"
58 +
59 source "drivers/mfd/Kconfig"
60
61 source "drivers/regulator/Kconfig"
62 --- a/drivers/Makefile
63 +++ b/drivers/Makefile
64 @@ -110,6 +110,7 @@ obj-$(CONFIG_HID) += hid/
65 obj-$(CONFIG_PPC_PS3) += ps3/
66 obj-$(CONFIG_OF) += of/
67 obj-$(CONFIG_SSB) += ssb/
68 +obj-$(CONFIG_BCMA) += bcma/
69 obj-$(CONFIG_VHOST_NET) += vhost/
70 obj-$(CONFIG_VLYNQ) += vlynq/
71 obj-$(CONFIG_STAGING) += staging/
72 --- /dev/null
73 +++ b/drivers/bcma/Kconfig
74 @@ -0,0 +1,38 @@
75 +config BCMA_POSSIBLE
76 + bool
77 + depends on HAS_IOMEM && HAS_DMA
78 + default y
79 +
80 +menu "Broadcom specific AMBA"
81 + depends on BCMA_POSSIBLE
82 +
83 +config BCMA
84 + tristate "BCMA support"
85 + depends on BCMA_POSSIBLE
86 + help
87 + Bus driver for Broadcom specific Advanced Microcontroller Bus
88 + Architecture.
89 +
90 +# Support for Block-I/O. SELECT this from the driver that needs it.
91 +config BCMA_BLOCKIO
92 + bool
93 + depends on BCMA
94 +
95 +config BCMA_HOST_PCI_POSSIBLE
96 + bool
97 + depends on BCMA && PCI = y
98 + default y
99 +
100 +config BCMA_HOST_PCI
101 + bool "Support for BCMA on PCI-host bus"
102 + depends on BCMA_HOST_PCI_POSSIBLE
103 +
104 +config BCMA_DEBUG
105 + bool "BCMA debugging"
106 + depends on BCMA
107 + help
108 + This turns on additional debugging messages.
109 +
110 + If unsure, say N
111 +
112 +endmenu
113 --- /dev/null
114 +++ b/drivers/bcma/Makefile
115 @@ -0,0 +1,7 @@
116 +bcma-y += main.o scan.o core.o sprom.o
117 +bcma-y += driver_chipcommon.o driver_chipcommon_pmu.o
118 +bcma-y += driver_pci.o
119 +bcma-$(CONFIG_BCMA_HOST_PCI) += host_pci.o
120 +obj-$(CONFIG_BCMA) += bcma.o
121 +
122 +ccflags-$(CONFIG_BCMA_DEBUG) := -DDEBUG
123 --- /dev/null
124 +++ b/drivers/bcma/README
125 @@ -0,0 +1,19 @@
126 +Broadcom introduced new bus as replacement for older SSB. It is based on AMBA,
127 +however from programming point of view there is nothing AMBA specific we use.
128 +
129 +Standard AMBA drivers are platform specific, have hardcoded addresses and use
130 +AMBA standard fields like CID and PID.
131 +
132 +In case of Broadcom's cards every device consists of:
133 +1) Broadcom specific AMBA device. It is put on AMBA bus, but can not be treated
134 + as standard AMBA device. Reading it's CID or PID can cause machine lockup.
135 +2) AMBA standard devices called ports or wrappers. They have CIDs (AMBA_CID)
136 + and PIDs (0x103BB369), but we do not use that info for anything. One of that
137 + devices is used for managing Broadcom specific core.
138 +
139 +Addresses of AMBA devices are not hardcoded in driver and have to be read from
140 +EPROM.
141 +
142 +In this situation we decided to introduce separated bus. It can contain up to
143 +16 devices identified by Broadcom specific fields: manufacturer, id, revision
144 +and class.
145 --- /dev/null
146 +++ b/drivers/bcma/TODO
147 @@ -0,0 +1,3 @@
148 +- Interrupts
149 +- Defines for PCI core driver
150 +- Create kernel Documentation (use info from README)
151 --- /dev/null
152 +++ b/drivers/bcma/bcma_private.h
153 @@ -0,0 +1,31 @@
154 +#ifndef LINUX_BCMA_PRIVATE_H_
155 +#define LINUX_BCMA_PRIVATE_H_
156 +
157 +#ifndef pr_fmt
158 +#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
159 +#endif
160 +
161 +#include <linux/bcma/bcma.h>
162 +#include <linux/delay.h>
163 +
164 +#define BCMA_CORE_SIZE 0x1000
165 +
166 +struct bcma_bus;
167 +
168 +/* main.c */
169 +int bcma_bus_register(struct bcma_bus *bus);
170 +void bcma_bus_unregister(struct bcma_bus *bus);
171 +
172 +/* scan.c */
173 +int bcma_bus_scan(struct bcma_bus *bus);
174 +
175 +/* sprom.c */
176 +int bcma_sprom_get(struct bcma_bus *bus);
177 +
178 +#ifdef CONFIG_BCMA_HOST_PCI
179 +/* host_pci.c */
180 +extern int __init bcma_host_pci_init(void);
181 +extern void __exit bcma_host_pci_exit(void);
182 +#endif /* CONFIG_BCMA_HOST_PCI */
183 +
184 +#endif
185 --- /dev/null
186 +++ b/drivers/bcma/core.c
187 @@ -0,0 +1,52 @@
188 +/*
189 + * Broadcom specific AMBA
190 + * Core ops
191 + *
192 + * Licensed under the GNU/GPL. See COPYING for details.
193 + */
194 +
195 +#include "bcma_private.h"
196 +#include <linux/bcma/bcma.h>
197 +
198 +bool bcma_core_is_enabled(struct bcma_device *core)
199 +{
200 + if ((bcma_aread32(core, BCMA_IOCTL) & (BCMA_IOCTL_CLK | BCMA_IOCTL_FGC))
201 + != BCMA_IOCTL_CLK)
202 + return false;
203 + if (bcma_aread32(core, BCMA_RESET_CTL) & BCMA_RESET_CTL_RESET)
204 + return false;
205 + return true;
206 +}
207 +EXPORT_SYMBOL_GPL(bcma_core_is_enabled);
208 +
209 +void bcma_core_disable(struct bcma_device *core, u32 flags)
210 +{
211 + if (bcma_aread32(core, BCMA_RESET_CTL) & BCMA_RESET_CTL_RESET)
212 + return;
213 +
214 + bcma_awrite32(core, BCMA_IOCTL, flags);
215 + bcma_aread32(core, BCMA_IOCTL);
216 + udelay(10);
217 +
218 + bcma_awrite32(core, BCMA_RESET_CTL, BCMA_RESET_CTL_RESET);
219 + udelay(1);
220 +}
221 +EXPORT_SYMBOL_GPL(bcma_core_disable);
222 +
223 +int bcma_core_enable(struct bcma_device *core, u32 flags)
224 +{
225 + bcma_core_disable(core, flags);
226 +
227 + bcma_awrite32(core, BCMA_IOCTL, (BCMA_IOCTL_CLK | BCMA_IOCTL_FGC | flags));
228 + bcma_aread32(core, BCMA_IOCTL);
229 +
230 + bcma_awrite32(core, BCMA_RESET_CTL, 0);
231 + udelay(1);
232 +
233 + bcma_awrite32(core, BCMA_IOCTL, (BCMA_IOCTL_CLK | flags));
234 + bcma_aread32(core, BCMA_IOCTL);
235 + udelay(1);
236 +
237 + return 0;
238 +}
239 +EXPORT_SYMBOL_GPL(bcma_core_enable);
240 --- /dev/null
241 +++ b/drivers/bcma/driver_chipcommon.c
242 @@ -0,0 +1,89 @@
243 +/*
244 + * Broadcom specific AMBA
245 + * ChipCommon core driver
246 + *
247 + * Copyright 2005, Broadcom Corporation
248 + * Copyright 2006, 2007, Michael Buesch <mb@bu3sch.de>
249 + *
250 + * Licensed under the GNU/GPL. See COPYING for details.
251 + */
252 +
253 +#include "bcma_private.h"
254 +#include <linux/bcma/bcma.h>
255 +
256 +static inline u32 bcma_cc_write32_masked(struct bcma_drv_cc *cc, u16 offset,
257 + u32 mask, u32 value)
258 +{
259 + value &= mask;
260 + value |= bcma_cc_read32(cc, offset) & ~mask;
261 + bcma_cc_write32(cc, offset, value);
262 +
263 + return value;
264 +}
265 +
266 +void bcma_core_chipcommon_init(struct bcma_drv_cc *cc)
267 +{
268 + if (cc->core->id.rev >= 11)
269 + cc->status = bcma_cc_read32(cc, BCMA_CC_CHIPSTAT);
270 + cc->capabilities = bcma_cc_read32(cc, BCMA_CC_CAP);
271 + if (cc->core->id.rev >= 35)
272 + cc->capabilities_ext = bcma_cc_read32(cc, BCMA_CC_CAP_EXT);
273 +
274 + if (cc->core->id.rev >= 20) {
275 + bcma_cc_write32(cc, BCMA_CC_GPIOPULLUP, 0);
276 + bcma_cc_write32(cc, BCMA_CC_GPIOPULLDOWN, 0);
277 + }
278 +
279 + if (cc->capabilities & BCMA_CC_CAP_PMU)
280 + bcma_pmu_init(cc);
281 + if (cc->capabilities & BCMA_CC_CAP_PCTL)
282 + pr_err("Power control not implemented!\n");
283 +}
284 +
285 +/* Set chip watchdog reset timer to fire in 'ticks' backplane cycles */
286 +void bcma_chipco_watchdog_timer_set(struct bcma_drv_cc *cc, u32 ticks)
287 +{
288 + /* instant NMI */
289 + bcma_cc_write32(cc, BCMA_CC_WATCHDOG, ticks);
290 +}
291 +
292 +void bcma_chipco_irq_mask(struct bcma_drv_cc *cc, u32 mask, u32 value)
293 +{
294 + bcma_cc_write32_masked(cc, BCMA_CC_IRQMASK, mask, value);
295 +}
296 +
297 +u32 bcma_chipco_irq_status(struct bcma_drv_cc *cc, u32 mask)
298 +{
299 + return bcma_cc_read32(cc, BCMA_CC_IRQSTAT) & mask;
300 +}
301 +
302 +u32 bcma_chipco_gpio_in(struct bcma_drv_cc *cc, u32 mask)
303 +{
304 + return bcma_cc_read32(cc, BCMA_CC_GPIOIN) & mask;
305 +}
306 +
307 +u32 bcma_chipco_gpio_out(struct bcma_drv_cc *cc, u32 mask, u32 value)
308 +{
309 + return bcma_cc_write32_masked(cc, BCMA_CC_GPIOOUT, mask, value);
310 +}
311 +
312 +u32 bcma_chipco_gpio_outen(struct bcma_drv_cc *cc, u32 mask, u32 value)
313 +{
314 + return bcma_cc_write32_masked(cc, BCMA_CC_GPIOOUTEN, mask, value);
315 +}
316 +
317 +u32 bcma_chipco_gpio_control(struct bcma_drv_cc *cc, u32 mask, u32 value)
318 +{
319 + return bcma_cc_write32_masked(cc, BCMA_CC_GPIOCTL, mask, value);
320 +}
321 +EXPORT_SYMBOL_GPL(bcma_chipco_gpio_control);
322 +
323 +u32 bcma_chipco_gpio_intmask(struct bcma_drv_cc *cc, u32 mask, u32 value)
324 +{
325 + return bcma_cc_write32_masked(cc, BCMA_CC_GPIOIRQ, mask, value);
326 +}
327 +
328 +u32 bcma_chipco_gpio_polarity(struct bcma_drv_cc *cc, u32 mask, u32 value)
329 +{
330 + return bcma_cc_write32_masked(cc, BCMA_CC_GPIOPOL, mask, value);
331 +}
332 --- /dev/null
333 +++ b/drivers/bcma/driver_chipcommon_pmu.c
334 @@ -0,0 +1,138 @@
335 +/*
336 + * Broadcom specific AMBA
337 + * ChipCommon Power Management Unit driver
338 + *
339 + * Copyright 2009, Michael Buesch <mb@bu3sch.de>
340 + * Copyright 2007, Broadcom Corporation
341 + *
342 + * Licensed under the GNU/GPL. See COPYING for details.
343 + */
344 +
345 +#include "bcma_private.h"
346 +#include <linux/bcma/bcma.h>
347 +
348 +static void bcma_chipco_chipctl_maskset(struct bcma_drv_cc *cc,
349 + u32 offset, u32 mask, u32 set)
350 +{
351 + u32 value;
352 +
353 + bcma_cc_read32(cc, BCMA_CC_CHIPCTL_ADDR);
354 + bcma_cc_write32(cc, BCMA_CC_CHIPCTL_ADDR, offset);
355 + bcma_cc_read32(cc, BCMA_CC_CHIPCTL_ADDR);
356 + value = bcma_cc_read32(cc, BCMA_CC_CHIPCTL_DATA);
357 + value &= mask;
358 + value |= set;
359 + bcma_cc_write32(cc, BCMA_CC_CHIPCTL_DATA, value);
360 + bcma_cc_read32(cc, BCMA_CC_CHIPCTL_DATA);
361 +}
362 +
363 +static void bcma_pmu_pll_init(struct bcma_drv_cc *cc)
364 +{
365 + struct bcma_bus *bus = cc->core->bus;
366 +
367 + switch (bus->chipinfo.id) {
368 + case 0x4313:
369 + case 0x4331:
370 + case 43224:
371 + case 43225:
372 + break;
373 + default:
374 + pr_err("PLL init unknown for device 0x%04X\n",
375 + bus->chipinfo.id);
376 + }
377 +}
378 +
379 +static void bcma_pmu_resources_init(struct bcma_drv_cc *cc)
380 +{
381 + struct bcma_bus *bus = cc->core->bus;
382 + u32 min_msk = 0, max_msk = 0;
383 +
384 + switch (bus->chipinfo.id) {
385 + case 0x4313:
386 + min_msk = 0x200D;
387 + max_msk = 0xFFFF;
388 + break;
389 + case 43224:
390 + case 43225:
391 + break;
392 + default:
393 + pr_err("PMU resource config unknown for device 0x%04X\n",
394 + bus->chipinfo.id);
395 + }
396 +
397 + /* Set the resource masks. */
398 + if (min_msk)
399 + bcma_cc_write32(cc, BCMA_CC_PMU_MINRES_MSK, min_msk);
400 + if (max_msk)
401 + bcma_cc_write32(cc, BCMA_CC_PMU_MAXRES_MSK, max_msk);
402 +}
403 +
404 +void bcma_pmu_swreg_init(struct bcma_drv_cc *cc)
405 +{
406 + struct bcma_bus *bus = cc->core->bus;
407 +
408 + switch (bus->chipinfo.id) {
409 + case 0x4313:
410 + case 0x4331:
411 + case 43224:
412 + case 43225:
413 + break;
414 + default:
415 + pr_err("PMU switch/regulators init unknown for device "
416 + "0x%04X\n", bus->chipinfo.id);
417 + }
418 +}
419 +
420 +void bcma_pmu_workarounds(struct bcma_drv_cc *cc)
421 +{
422 + struct bcma_bus *bus = cc->core->bus;
423 +
424 + switch (bus->chipinfo.id) {
425 + case 0x4313:
426 + bcma_chipco_chipctl_maskset(cc, 0, ~0, 0x7);
427 + break;
428 + case 0x4331:
429 + pr_err("Enabling Ext PA lines not implemented\n");
430 + break;
431 + case 43224:
432 + if (bus->chipinfo.rev == 0) {
433 + pr_err("Workarounds for 43224 rev 0 not fully "
434 + "implemented\n");
435 + bcma_chipco_chipctl_maskset(cc, 0, ~0, 0x00F000F0);
436 + } else {
437 + bcma_chipco_chipctl_maskset(cc, 0, ~0, 0xF0);
438 + }
439 + break;
440 + case 43225:
441 + break;
442 + default:
443 + pr_err("Workarounds unknown for device 0x%04X\n",
444 + bus->chipinfo.id);
445 + }
446 +}
447 +
448 +void bcma_pmu_init(struct bcma_drv_cc *cc)
449 +{
450 + u32 pmucap;
451 +
452 + pmucap = bcma_cc_read32(cc, BCMA_CC_PMU_CAP);
453 + cc->pmu.rev = (pmucap & BCMA_CC_PMU_CAP_REVISION);
454 +
455 + pr_debug("Found rev %u PMU (capabilities 0x%08X)\n", cc->pmu.rev,
456 + pmucap);
457 +
458 + if (cc->pmu.rev == 1)
459 + bcma_cc_mask32(cc, BCMA_CC_PMU_CTL,
460 + ~BCMA_CC_PMU_CTL_NOILPONW);
461 + else
462 + bcma_cc_set32(cc, BCMA_CC_PMU_CTL,
463 + BCMA_CC_PMU_CTL_NOILPONW);
464 +
465 + if (cc->core->id.id == 0x4329 && cc->core->id.rev == 2)
466 + pr_err("Fix for 4329b0 bad LPOM state not implemented!\n");
467 +
468 + bcma_pmu_pll_init(cc);
469 + bcma_pmu_resources_init(cc);
470 + bcma_pmu_swreg_init(cc);
471 + bcma_pmu_workarounds(cc);
472 +}
473 --- /dev/null
474 +++ b/drivers/bcma/driver_pci.c
475 @@ -0,0 +1,187 @@
476 +/*
477 + * Broadcom specific AMBA
478 + * PCI Core
479 + *
480 + * Copyright 2005, Broadcom Corporation
481 + * Copyright 2006, 2007, Michael Buesch <mb@bu3sch.de>
482 + *
483 + * Licensed under the GNU/GPL. See COPYING for details.
484 + */
485 +
486 +#include "bcma_private.h"
487 +#include <linux/bcma/bcma.h>
488 +
489 +/**************************************************
490 + * R/W ops.
491 + **************************************************/
492 +
493 +static u32 bcma_pcie_read(struct bcma_drv_pci *pc, u32 address)
494 +{
495 + pcicore_write32(pc, 0x130, address);
496 + pcicore_read32(pc, 0x130);
497 + return pcicore_read32(pc, 0x134);
498 +}
499 +
500 +#if 0
501 +static void bcma_pcie_write(struct bcma_drv_pci *pc, u32 address, u32 data)
502 +{
503 + pcicore_write32(pc, 0x130, address);
504 + pcicore_read32(pc, 0x130);
505 + pcicore_write32(pc, 0x134, data);
506 +}
507 +#endif
508 +
509 +static void bcma_pcie_mdio_set_phy(struct bcma_drv_pci *pc, u8 phy)
510 +{
511 + const u16 mdio_control = 0x128;
512 + const u16 mdio_data = 0x12C;
513 + u32 v;
514 + int i;
515 +
516 + v = (1 << 30); /* Start of Transaction */
517 + v |= (1 << 28); /* Write Transaction */
518 + v |= (1 << 17); /* Turnaround */
519 + v |= (0x1F << 18);
520 + v |= (phy << 4);
521 + pcicore_write32(pc, mdio_data, v);
522 +
523 + udelay(10);
524 + for (i = 0; i < 200; i++) {
525 + v = pcicore_read32(pc, mdio_control);
526 + if (v & 0x100 /* Trans complete */)
527 + break;
528 + msleep(1);
529 + }
530 +}
531 +
532 +static u16 bcma_pcie_mdio_read(struct bcma_drv_pci *pc, u8 device, u8 address)
533 +{
534 + const u16 mdio_control = 0x128;
535 + const u16 mdio_data = 0x12C;
536 + int max_retries = 10;
537 + u16 ret = 0;
538 + u32 v;
539 + int i;
540 +
541 + v = 0x80; /* Enable Preamble Sequence */
542 + v |= 0x2; /* MDIO Clock Divisor */
543 + pcicore_write32(pc, mdio_control, v);
544 +
545 + if (pc->core->id.rev >= 10) {
546 + max_retries = 200;
547 + bcma_pcie_mdio_set_phy(pc, device);
548 + }
549 +
550 + v = (1 << 30); /* Start of Transaction */
551 + v |= (1 << 29); /* Read Transaction */
552 + v |= (1 << 17); /* Turnaround */
553 + if (pc->core->id.rev < 10)
554 + v |= (u32)device << 22;
555 + v |= (u32)address << 18;
556 + pcicore_write32(pc, mdio_data, v);
557 + /* Wait for the device to complete the transaction */
558 + udelay(10);
559 + for (i = 0; i < max_retries; i++) {
560 + v = pcicore_read32(pc, mdio_control);
561 + if (v & 0x100 /* Trans complete */) {
562 + udelay(10);
563 + ret = pcicore_read32(pc, mdio_data);
564 + break;
565 + }
566 + msleep(1);
567 + }
568 + pcicore_write32(pc, mdio_control, 0);
569 + return ret;
570 +}
571 +
572 +static void bcma_pcie_mdio_write(struct bcma_drv_pci *pc, u8 device,
573 + u8 address, u16 data)
574 +{
575 + const u16 mdio_control = 0x128;
576 + const u16 mdio_data = 0x12C;
577 + int max_retries = 10;
578 + u32 v;
579 + int i;
580 +
581 + v = 0x80; /* Enable Preamble Sequence */
582 + v |= 0x2; /* MDIO Clock Divisor */
583 + pcicore_write32(pc, mdio_control, v);
584 +
585 + if (pc->core->id.rev >= 10) {
586 + max_retries = 200;
587 + bcma_pcie_mdio_set_phy(pc, device);
588 + }
589 +
590 + v = (1 << 30); /* Start of Transaction */
591 + v |= (1 << 28); /* Write Transaction */
592 + v |= (1 << 17); /* Turnaround */
593 + if (pc->core->id.rev < 10)
594 + v |= (u32)device << 22;
595 + v |= (u32)address << 18;
596 + v |= data;
597 + pcicore_write32(pc, mdio_data, v);
598 + /* Wait for the device to complete the transaction */
599 + udelay(10);
600 + for (i = 0; i < max_retries; i++) {
601 + v = pcicore_read32(pc, mdio_control);
602 + if (v & 0x100 /* Trans complete */)
603 + break;
604 + msleep(1);
605 + }
606 + pcicore_write32(pc, mdio_control, 0);
607 +}
608 +
609 +/**************************************************
610 + * Workarounds.
611 + **************************************************/
612 +
613 +static u8 bcma_pcicore_polarity_workaround(struct bcma_drv_pci *pc)
614 +{
615 + return (bcma_pcie_read(pc, 0x204) & 0x10) ? 0xC0 : 0x80;
616 +}
617 +
618 +static void bcma_pcicore_serdes_workaround(struct bcma_drv_pci *pc)
619 +{
620 + const u8 serdes_pll_device = 0x1D;
621 + const u8 serdes_rx_device = 0x1F;
622 + u16 tmp;
623 +
624 + bcma_pcie_mdio_write(pc, serdes_rx_device, 1 /* Control */,
625 + bcma_pcicore_polarity_workaround(pc));
626 + tmp = bcma_pcie_mdio_read(pc, serdes_pll_device, 1 /* Control */);
627 + if (tmp & 0x4000)
628 + bcma_pcie_mdio_write(pc, serdes_pll_device, 1, tmp & ~0x4000);
629 +}
630 +
631 +/**************************************************
632 + * Init.
633 + **************************************************/
634 +
635 +void bcma_core_pci_init(struct bcma_drv_pci *pc)
636 +{
637 + bcma_pcicore_serdes_workaround(pc);
638 +}
639 +
640 +int bcma_core_pci_irq_ctl(struct bcma_drv_pci *pc, struct bcma_device *core,
641 + bool enable)
642 +{
643 + struct pci_dev *pdev = pc->core->bus->host_pci;
644 + u32 coremask, tmp;
645 + int err;
646 +
647 + err = pci_read_config_dword(pdev, BCMA_PCI_IRQMASK, &tmp);
648 + if (err)
649 + goto out;
650 +
651 + coremask = BIT(core->core_index) << 8;
652 + if (enable)
653 + tmp |= coremask;
654 + else
655 + tmp &= ~coremask;
656 +
657 + err = pci_write_config_dword(pdev, BCMA_PCI_IRQMASK, tmp);
658 +
659 +out:
660 + return err;
661 +}
662 +EXPORT_SYMBOL_GPL(bcma_core_pci_irq_ctl);
663 --- /dev/null
664 +++ b/drivers/bcma/host_pci.c
665 @@ -0,0 +1,251 @@
666 +/*
667 + * Broadcom specific AMBA
668 + * PCI Host
669 + *
670 + * Licensed under the GNU/GPL. See COPYING for details.
671 + */
672 +
673 +#include "bcma_private.h"
674 +#include <linux/slab.h>
675 +#include <linux/bcma/bcma.h>
676 +#include <linux/pci.h>
677 +
678 +static void bcma_host_pci_switch_core(struct bcma_device *core)
679 +{
680 + pci_write_config_dword(core->bus->host_pci, BCMA_PCI_BAR0_WIN,
681 + core->addr);
682 + pci_write_config_dword(core->bus->host_pci, BCMA_PCI_BAR0_WIN2,
683 + core->wrap);
684 + core->bus->mapped_core = core;
685 + pr_debug("Switched to core: 0x%X\n", core->id.id);
686 +}
687 +
688 +static u8 bcma_host_pci_read8(struct bcma_device *core, u16 offset)
689 +{
690 + if (core->bus->mapped_core != core)
691 + bcma_host_pci_switch_core(core);
692 + return ioread8(core->bus->mmio + offset);
693 +}
694 +
695 +static u16 bcma_host_pci_read16(struct bcma_device *core, u16 offset)
696 +{
697 + if (core->bus->mapped_core != core)
698 + bcma_host_pci_switch_core(core);
699 + return ioread16(core->bus->mmio + offset);
700 +}
701 +
702 +static u32 bcma_host_pci_read32(struct bcma_device *core, u16 offset)
703 +{
704 + if (core->bus->mapped_core != core)
705 + bcma_host_pci_switch_core(core);
706 + return ioread32(core->bus->mmio + offset);
707 +}
708 +
709 +static void bcma_host_pci_write8(struct bcma_device *core, u16 offset,
710 + u8 value)
711 +{
712 + if (core->bus->mapped_core != core)
713 + bcma_host_pci_switch_core(core);
714 + iowrite8(value, core->bus->mmio + offset);
715 +}
716 +
717 +static void bcma_host_pci_write16(struct bcma_device *core, u16 offset,
718 + u16 value)
719 +{
720 + if (core->bus->mapped_core != core)
721 + bcma_host_pci_switch_core(core);
722 + iowrite16(value, core->bus->mmio + offset);
723 +}
724 +
725 +static void bcma_host_pci_write32(struct bcma_device *core, u16 offset,
726 + u32 value)
727 +{
728 + if (core->bus->mapped_core != core)
729 + bcma_host_pci_switch_core(core);
730 + iowrite32(value, core->bus->mmio + offset);
731 +}
732 +
733 +#ifdef CONFIG_BCMA_BLOCKIO
734 +void bcma_host_pci_block_read(struct bcma_device *core, void *buffer,
735 + size_t count, u16 offset, u8 reg_width)
736 +{
737 + void __iomem *addr = core->bus->mmio + offset;
738 + if (core->bus->mapped_core != core)
739 + bcma_host_pci_switch_core(core);
740 + switch (reg_width) {
741 + case sizeof(u8):
742 + ioread8_rep(addr, buffer, count);
743 + break;
744 + case sizeof(u16):
745 + WARN_ON(count & 1);
746 + ioread16_rep(addr, buffer, count >> 1);
747 + break;
748 + case sizeof(u32):
749 + WARN_ON(count & 3);
750 + ioread32_rep(addr, buffer, count >> 2);
751 + break;
752 + default:
753 + WARN_ON(1);
754 + }
755 +}
756 +
757 +void bcma_host_pci_block_write(struct bcma_device *core, const void *buffer,
758 + size_t count, u16 offset, u8 reg_width)
759 +{
760 + void __iomem *addr = core->bus->mmio + offset;
761 + if (core->bus->mapped_core != core)
762 + bcma_host_pci_switch_core(core);
763 + switch (reg_width) {
764 + case sizeof(u8):
765 + iowrite8_rep(addr, buffer, count);
766 + break;
767 + case sizeof(u16):
768 + WARN_ON(count & 1);
769 + iowrite16_rep(addr, buffer, count >> 1);
770 + break;
771 + case sizeof(u32):
772 + WARN_ON(count & 3);
773 + iowrite32_rep(addr, buffer, count >> 2);
774 + break;
775 + default:
776 + WARN_ON(1);
777 + }
778 +}
779 +#endif
780 +
781 +static u32 bcma_host_pci_aread32(struct bcma_device *core, u16 offset)
782 +{
783 + if (core->bus->mapped_core != core)
784 + bcma_host_pci_switch_core(core);
785 + return ioread32(core->bus->mmio + (1 * BCMA_CORE_SIZE) + offset);
786 +}
787 +
788 +static void bcma_host_pci_awrite32(struct bcma_device *core, u16 offset,
789 + u32 value)
790 +{
791 + if (core->bus->mapped_core != core)
792 + bcma_host_pci_switch_core(core);
793 + iowrite32(value, core->bus->mmio + (1 * BCMA_CORE_SIZE) + offset);
794 +}
795 +
796 +const struct bcma_host_ops bcma_host_pci_ops = {
797 + .read8 = bcma_host_pci_read8,
798 + .read16 = bcma_host_pci_read16,
799 + .read32 = bcma_host_pci_read32,
800 + .write8 = bcma_host_pci_write8,
801 + .write16 = bcma_host_pci_write16,
802 + .write32 = bcma_host_pci_write32,
803 +#ifdef CONFIG_BCMA_BLOCKIO
804 + .block_read = bcma_host_pci_block_read,
805 + .block_write = bcma_host_pci_block_write,
806 +#endif
807 + .aread32 = bcma_host_pci_aread32,
808 + .awrite32 = bcma_host_pci_awrite32,
809 +};
810 +
811 +static int bcma_host_pci_probe(struct pci_dev *dev,
812 + const struct pci_device_id *id)
813 +{
814 + struct bcma_bus *bus;
815 + int err = -ENOMEM;
816 + const char *name;
817 + u32 val;
818 +
819 + /* Alloc */
820 + bus = kzalloc(sizeof(*bus), GFP_KERNEL);
821 + if (!bus)
822 + goto out;
823 +
824 + /* Basic PCI configuration */
825 + err = pci_enable_device(dev);
826 + if (err)
827 + goto err_kfree_bus;
828 +
829 + name = dev_name(&dev->dev);
830 + if (dev->driver && dev->driver->name)
831 + name = dev->driver->name;
832 + err = pci_request_regions(dev, name);
833 + if (err)
834 + goto err_pci_disable;
835 + pci_set_master(dev);
836 +
837 + /* Disable the RETRY_TIMEOUT register (0x41) to keep
838 + * PCI Tx retries from interfering with C3 CPU state */
839 + pci_read_config_dword(dev, 0x40, &val);
840 + if ((val & 0x0000ff00) != 0)
841 + pci_write_config_dword(dev, 0x40, val & 0xffff00ff);
842 +
843 + /* SSB needed additional powering up, do we have any AMBA PCI cards? */
844 + if (!pci_is_pcie(dev))
845 + pr_err("PCI card detected, report problems.\n");
846 +
847 + /* Map MMIO */
848 + err = -ENOMEM;
849 + bus->mmio = pci_iomap(dev, 0, ~0UL);
850 + if (!bus->mmio)
851 + goto err_pci_release_regions;
852 +
853 + /* Host specific */
854 + bus->host_pci = dev;
855 + bus->hosttype = BCMA_HOSTTYPE_PCI;
856 + bus->ops = &bcma_host_pci_ops;
857 +
858 + /* Register */
859 + err = bcma_bus_register(bus);
860 + if (err)
861 + goto err_pci_unmap_mmio;
862 +
863 + pci_set_drvdata(dev, bus);
864 +
865 +out:
866 + return err;
867 +
868 +err_pci_unmap_mmio:
869 + pci_iounmap(dev, bus->mmio);
870 +err_pci_release_regions:
871 + pci_release_regions(dev);
872 +err_pci_disable:
873 + pci_disable_device(dev);
874 +err_kfree_bus:
875 + kfree(bus);
876 + return err;
877 +}
878 +
879 +static void bcma_host_pci_remove(struct pci_dev *dev)
880 +{
881 + struct bcma_bus *bus = pci_get_drvdata(dev);
882 +
883 + bcma_bus_unregister(bus);
884 + pci_iounmap(dev, bus->mmio);
885 + pci_release_regions(dev);
886 + pci_disable_device(dev);
887 + kfree(bus);
888 + pci_set_drvdata(dev, NULL);
889 +}
890 +
891 +static DEFINE_PCI_DEVICE_TABLE(bcma_pci_bridge_tbl) = {
892 + { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x0576) },
893 + { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4331) },
894 + { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4353) },
895 + { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4357) },
896 + { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4727) },
897 + { 0, },
898 +};
899 +MODULE_DEVICE_TABLE(pci, bcma_pci_bridge_tbl);
900 +
901 +static struct pci_driver bcma_pci_bridge_driver = {
902 + .name = "bcma-pci-bridge",
903 + .id_table = bcma_pci_bridge_tbl,
904 + .probe = bcma_host_pci_probe,
905 + .remove = bcma_host_pci_remove,
906 +};
907 +
908 +int __init bcma_host_pci_init(void)
909 +{
910 + return pci_register_driver(&bcma_pci_bridge_driver);
911 +}
912 +
913 +void __exit bcma_host_pci_exit(void)
914 +{
915 + pci_unregister_driver(&bcma_pci_bridge_driver);
916 +}
917 --- /dev/null
918 +++ b/drivers/bcma/main.c
919 @@ -0,0 +1,254 @@
920 +/*
921 + * Broadcom specific AMBA
922 + * Bus subsystem
923 + *
924 + * Licensed under the GNU/GPL. See COPYING for details.
925 + */
926 +
927 +#include "bcma_private.h"
928 +#include <linux/bcma/bcma.h>
929 +
930 +MODULE_DESCRIPTION("Broadcom's specific AMBA driver");
931 +MODULE_LICENSE("GPL");
932 +
933 +static int bcma_bus_match(struct device *dev, struct device_driver *drv);
934 +static int bcma_device_probe(struct device *dev);
935 +static int bcma_device_remove(struct device *dev);
936 +
937 +static ssize_t manuf_show(struct device *dev, struct device_attribute *attr, char *buf)
938 +{
939 + struct bcma_device *core = container_of(dev, struct bcma_device, dev);
940 + return sprintf(buf, "0x%03X\n", core->id.manuf);
941 +}
942 +static ssize_t id_show(struct device *dev, struct device_attribute *attr, char *buf)
943 +{
944 + struct bcma_device *core = container_of(dev, struct bcma_device, dev);
945 + return sprintf(buf, "0x%03X\n", core->id.id);
946 +}
947 +static ssize_t rev_show(struct device *dev, struct device_attribute *attr, char *buf)
948 +{
949 + struct bcma_device *core = container_of(dev, struct bcma_device, dev);
950 + return sprintf(buf, "0x%02X\n", core->id.rev);
951 +}
952 +static ssize_t class_show(struct device *dev, struct device_attribute *attr, char *buf)
953 +{
954 + struct bcma_device *core = container_of(dev, struct bcma_device, dev);
955 + return sprintf(buf, "0x%X\n", core->id.class);
956 +}
957 +static struct device_attribute bcma_device_attrs[] = {
958 + __ATTR_RO(manuf),
959 + __ATTR_RO(id),
960 + __ATTR_RO(rev),
961 + __ATTR_RO(class),
962 + __ATTR_NULL,
963 +};
964 +
965 +static struct bus_type bcma_bus_type = {
966 + .name = "bcma",
967 + .match = bcma_bus_match,
968 + .probe = bcma_device_probe,
969 + .remove = bcma_device_remove,
970 + .dev_attrs = bcma_device_attrs,
971 +};
972 +
973 +static struct bcma_device *bcma_find_core(struct bcma_bus *bus, u16 coreid)
974 +{
975 + struct bcma_device *core;
976 +
977 + list_for_each_entry(core, &bus->cores, list) {
978 + if (core->id.id == coreid)
979 + return core;
980 + }
981 + return NULL;
982 +}
983 +
984 +static void bcma_release_core_dev(struct device *dev)
985 +{
986 + struct bcma_device *core = container_of(dev, struct bcma_device, dev);
987 + kfree(core);
988 +}
989 +
990 +static int bcma_register_cores(struct bcma_bus *bus)
991 +{
992 + struct bcma_device *core;
993 + int err, dev_id = 0;
994 +
995 + list_for_each_entry(core, &bus->cores, list) {
996 + /* We support that cores ourself */
997 + switch (core->id.id) {
998 + case BCMA_CORE_CHIPCOMMON:
999 + case BCMA_CORE_PCI:
1000 + case BCMA_CORE_PCIE:
1001 + continue;
1002 + }
1003 +
1004 + core->dev.release = bcma_release_core_dev;
1005 + core->dev.bus = &bcma_bus_type;
1006 + dev_set_name(&core->dev, "bcma%d:%d", 0/*bus->num*/, dev_id);
1007 +
1008 + switch (bus->hosttype) {
1009 + case BCMA_HOSTTYPE_PCI:
1010 + core->dev.parent = &bus->host_pci->dev;
1011 + core->dma_dev = &bus->host_pci->dev;
1012 + core->irq = bus->host_pci->irq;
1013 + break;
1014 + case BCMA_HOSTTYPE_NONE:
1015 + case BCMA_HOSTTYPE_SDIO:
1016 + break;
1017 + }
1018 +
1019 + err = device_register(&core->dev);
1020 + if (err) {
1021 + pr_err("Could not register dev for core 0x%03X\n",
1022 + core->id.id);
1023 + continue;
1024 + }
1025 + core->dev_registered = true;
1026 + dev_id++;
1027 + }
1028 +
1029 + return 0;
1030 +}
1031 +
1032 +static void bcma_unregister_cores(struct bcma_bus *bus)
1033 +{
1034 + struct bcma_device *core;
1035 +
1036 + list_for_each_entry(core, &bus->cores, list) {
1037 + if (core->dev_registered)
1038 + device_unregister(&core->dev);
1039 + }
1040 +}
1041 +
1042 +int bcma_bus_register(struct bcma_bus *bus)
1043 +{
1044 + int err;
1045 + struct bcma_device *core;
1046 +
1047 + /* Scan for devices (cores) */
1048 + err = bcma_bus_scan(bus);
1049 + if (err) {
1050 + pr_err("Failed to scan: %d\n", err);
1051 + return -1;
1052 + }
1053 +
1054 + /* Init CC core */
1055 + core = bcma_find_core(bus, BCMA_CORE_CHIPCOMMON);
1056 + if (core) {
1057 + bus->drv_cc.core = core;
1058 + bcma_core_chipcommon_init(&bus->drv_cc);
1059 + }
1060 +
1061 + /* Init PCIE core */
1062 + core = bcma_find_core(bus, BCMA_CORE_PCIE);
1063 + if (core) {
1064 + bus->drv_pci.core = core;
1065 + bcma_core_pci_init(&bus->drv_pci);
1066 + }
1067 +
1068 + /* Try to get SPROM */
1069 + err = bcma_sprom_get(bus);
1070 + if (err) {
1071 + pr_err("Failed to get SPROM: %d\n", err);
1072 + return -ENOENT;
1073 + }
1074 +
1075 + /* Register found cores */
1076 + bcma_register_cores(bus);
1077 +
1078 + pr_info("Bus registered\n");
1079 +
1080 + return 0;
1081 +}
1082 +
1083 +void bcma_bus_unregister(struct bcma_bus *bus)
1084 +{
1085 + bcma_unregister_cores(bus);
1086 +}
1087 +
1088 +int __bcma_driver_register(struct bcma_driver *drv, struct module *owner)
1089 +{
1090 + drv->drv.name = drv->name;
1091 + drv->drv.bus = &bcma_bus_type;
1092 + drv->drv.owner = owner;
1093 +
1094 + return driver_register(&drv->drv);
1095 +}
1096 +EXPORT_SYMBOL_GPL(__bcma_driver_register);
1097 +
1098 +void bcma_driver_unregister(struct bcma_driver *drv)
1099 +{
1100 + driver_unregister(&drv->drv);
1101 +}
1102 +EXPORT_SYMBOL_GPL(bcma_driver_unregister);
1103 +
1104 +static int bcma_bus_match(struct device *dev, struct device_driver *drv)
1105 +{
1106 + struct bcma_device *core = container_of(dev, struct bcma_device, dev);
1107 + struct bcma_driver *adrv = container_of(drv, struct bcma_driver, drv);
1108 + const struct bcma_device_id *cid = &core->id;
1109 + const struct bcma_device_id *did;
1110 +
1111 + for (did = adrv->id_table; did->manuf || did->id || did->rev; did++) {
1112 + if ((did->manuf == cid->manuf || did->manuf == BCMA_ANY_MANUF) &&
1113 + (did->id == cid->id || did->id == BCMA_ANY_ID) &&
1114 + (did->rev == cid->rev || did->rev == BCMA_ANY_REV) &&
1115 + (did->class == cid->class || did->class == BCMA_ANY_CLASS))
1116 + return 1;
1117 + }
1118 + return 0;
1119 +}
1120 +
1121 +static int bcma_device_probe(struct device *dev)
1122 +{
1123 + struct bcma_device *core = container_of(dev, struct bcma_device, dev);
1124 + struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver,
1125 + drv);
1126 + int err = 0;
1127 +
1128 + if (adrv->probe)
1129 + err = adrv->probe(core);
1130 +
1131 + return err;
1132 +}
1133 +
1134 +static int bcma_device_remove(struct device *dev)
1135 +{
1136 + struct bcma_device *core = container_of(dev, struct bcma_device, dev);
1137 + struct bcma_driver *adrv = container_of(dev->driver, struct bcma_driver,
1138 + drv);
1139 +
1140 + if (adrv->remove)
1141 + adrv->remove(core);
1142 +
1143 + return 0;
1144 +}
1145 +
1146 +static int __init bcma_modinit(void)
1147 +{
1148 + int err;
1149 +
1150 + err = bus_register(&bcma_bus_type);
1151 + if (err)
1152 + return err;
1153 +
1154 +#ifdef CONFIG_BCMA_HOST_PCI
1155 + err = bcma_host_pci_init();
1156 + if (err) {
1157 + pr_err("PCI host initialization failed\n");
1158 + err = 0;
1159 + }
1160 +#endif
1161 +
1162 + return err;
1163 +}
1164 +fs_initcall(bcma_modinit);
1165 +
1166 +static void __exit bcma_modexit(void)
1167 +{
1168 +#ifdef CONFIG_BCMA_HOST_PCI
1169 + bcma_host_pci_exit();
1170 +#endif
1171 + bus_unregister(&bcma_bus_type);
1172 +}
1173 +module_exit(bcma_modexit)
1174 --- /dev/null
1175 +++ b/drivers/bcma/scan.c
1176 @@ -0,0 +1,360 @@
1177 +/*
1178 + * Broadcom specific AMBA
1179 + * Bus scanning
1180 + *
1181 + * Licensed under the GNU/GPL. See COPYING for details.
1182 + */
1183 +
1184 +#include "scan.h"
1185 +#include "bcma_private.h"
1186 +
1187 +#include <linux/bcma/bcma.h>
1188 +#include <linux/bcma/bcma_regs.h>
1189 +#include <linux/pci.h>
1190 +#include <linux/io.h>
1191 +#include <linux/dma-mapping.h>
1192 +#include <linux/slab.h>
1193 +
1194 +struct bcma_device_id_name {
1195 + u16 id;
1196 + const char *name;
1197 +};
1198 +struct bcma_device_id_name bcma_device_names[] = {
1199 + { BCMA_CORE_OOB_ROUTER, "OOB Router" },
1200 + { BCMA_CORE_INVALID, "Invalid" },
1201 + { BCMA_CORE_CHIPCOMMON, "ChipCommon" },
1202 + { BCMA_CORE_ILINE20, "ILine 20" },
1203 + { BCMA_CORE_SRAM, "SRAM" },
1204 + { BCMA_CORE_SDRAM, "SDRAM" },
1205 + { BCMA_CORE_PCI, "PCI" },
1206 + { BCMA_CORE_MIPS, "MIPS" },
1207 + { BCMA_CORE_ETHERNET, "Fast Ethernet" },
1208 + { BCMA_CORE_V90, "V90" },
1209 + { BCMA_CORE_USB11_HOSTDEV, "USB 1.1 Hostdev" },
1210 + { BCMA_CORE_ADSL, "ADSL" },
1211 + { BCMA_CORE_ILINE100, "ILine 100" },
1212 + { BCMA_CORE_IPSEC, "IPSEC" },
1213 + { BCMA_CORE_UTOPIA, "UTOPIA" },
1214 + { BCMA_CORE_PCMCIA, "PCMCIA" },
1215 + { BCMA_CORE_INTERNAL_MEM, "Internal Memory" },
1216 + { BCMA_CORE_MEMC_SDRAM, "MEMC SDRAM" },
1217 + { BCMA_CORE_OFDM, "OFDM" },
1218 + { BCMA_CORE_EXTIF, "EXTIF" },
1219 + { BCMA_CORE_80211, "IEEE 802.11" },
1220 + { BCMA_CORE_PHY_A, "PHY A" },
1221 + { BCMA_CORE_PHY_B, "PHY B" },
1222 + { BCMA_CORE_PHY_G, "PHY G" },
1223 + { BCMA_CORE_MIPS_3302, "MIPS 3302" },
1224 + { BCMA_CORE_USB11_HOST, "USB 1.1 Host" },
1225 + { BCMA_CORE_USB11_DEV, "USB 1.1 Device" },
1226 + { BCMA_CORE_USB20_HOST, "USB 2.0 Host" },
1227 + { BCMA_CORE_USB20_DEV, "USB 2.0 Device" },
1228 + { BCMA_CORE_SDIO_HOST, "SDIO Host" },
1229 + { BCMA_CORE_ROBOSWITCH, "Roboswitch" },
1230 + { BCMA_CORE_PARA_ATA, "PATA" },
1231 + { BCMA_CORE_SATA_XORDMA, "SATA XOR-DMA" },
1232 + { BCMA_CORE_ETHERNET_GBIT, "GBit Ethernet" },
1233 + { BCMA_CORE_PCIE, "PCIe" },
1234 + { BCMA_CORE_PHY_N, "PHY N" },
1235 + { BCMA_CORE_SRAM_CTL, "SRAM Controller" },
1236 + { BCMA_CORE_MINI_MACPHY, "Mini MACPHY" },
1237 + { BCMA_CORE_ARM_1176, "ARM 1176" },
1238 + { BCMA_CORE_ARM_7TDMI, "ARM 7TDMI" },
1239 + { BCMA_CORE_PHY_LP, "PHY LP" },
1240 + { BCMA_CORE_PMU, "PMU" },
1241 + { BCMA_CORE_PHY_SSN, "PHY SSN" },
1242 + { BCMA_CORE_SDIO_DEV, "SDIO Device" },
1243 + { BCMA_CORE_ARM_CM3, "ARM CM3" },
1244 + { BCMA_CORE_PHY_HT, "PHY HT" },
1245 + { BCMA_CORE_MIPS_74K, "MIPS 74K" },
1246 + { BCMA_CORE_MAC_GBIT, "GBit MAC" },
1247 + { BCMA_CORE_DDR12_MEM_CTL, "DDR1/DDR2 Memory Controller" },
1248 + { BCMA_CORE_PCIE_RC, "PCIe Root Complex" },
1249 + { BCMA_CORE_OCP_OCP_BRIDGE, "OCP to OCP Bridge" },
1250 + { BCMA_CORE_SHARED_COMMON, "Common Shared" },
1251 + { BCMA_CORE_OCP_AHB_BRIDGE, "OCP to AHB Bridge" },
1252 + { BCMA_CORE_SPI_HOST, "SPI Host" },
1253 + { BCMA_CORE_I2S, "I2S" },
1254 + { BCMA_CORE_SDR_DDR1_MEM_CTL, "SDR/DDR1 Memory Controller" },
1255 + { BCMA_CORE_SHIM, "SHIM" },
1256 + { BCMA_CORE_DEFAULT, "Default" },
1257 +};
1258 +const char *bcma_device_name(struct bcma_device_id *id)
1259 +{
1260 + int i;
1261 +
1262 + if (id->manuf == BCMA_MANUF_BCM) {
1263 + for (i = 0; i < ARRAY_SIZE(bcma_device_names); i++) {
1264 + if (bcma_device_names[i].id == id->id)
1265 + return bcma_device_names[i].name;
1266 + }
1267 + }
1268 + return "UNKNOWN";
1269 +}
1270 +
1271 +static u32 bcma_scan_read32(struct bcma_bus *bus, u8 current_coreidx,
1272 + u16 offset)
1273 +{
1274 + return readl(bus->mmio + offset);
1275 +}
1276 +
1277 +static void bcma_scan_switch_core(struct bcma_bus *bus, u32 addr)
1278 +{
1279 + if (bus->hosttype == BCMA_HOSTTYPE_PCI)
1280 + pci_write_config_dword(bus->host_pci, BCMA_PCI_BAR0_WIN,
1281 + addr);
1282 +}
1283 +
1284 +static u32 bcma_erom_get_ent(struct bcma_bus *bus, u32 **eromptr)
1285 +{
1286 + u32 ent = readl(*eromptr);
1287 + (*eromptr)++;
1288 + return ent;
1289 +}
1290 +
1291 +static void bcma_erom_push_ent(u32 **eromptr)
1292 +{
1293 + (*eromptr)--;
1294 +}
1295 +
1296 +static s32 bcma_erom_get_ci(struct bcma_bus *bus, u32 **eromptr)
1297 +{
1298 + u32 ent = bcma_erom_get_ent(bus, eromptr);
1299 + if (!(ent & SCAN_ER_VALID))
1300 + return -ENOENT;
1301 + if ((ent & SCAN_ER_TAG) != SCAN_ER_TAG_CI)
1302 + return -ENOENT;
1303 + return ent;
1304 +}
1305 +
1306 +static bool bcma_erom_is_end(struct bcma_bus *bus, u32 **eromptr)
1307 +{
1308 + u32 ent = bcma_erom_get_ent(bus, eromptr);
1309 + bcma_erom_push_ent(eromptr);
1310 + return (ent == (SCAN_ER_TAG_END | SCAN_ER_VALID));
1311 +}
1312 +
1313 +static bool bcma_erom_is_bridge(struct bcma_bus *bus, u32 **eromptr)
1314 +{
1315 + u32 ent = bcma_erom_get_ent(bus, eromptr);
1316 + bcma_erom_push_ent(eromptr);
1317 + return (((ent & SCAN_ER_VALID)) &&
1318 + ((ent & SCAN_ER_TAGX) == SCAN_ER_TAG_ADDR) &&
1319 + ((ent & SCAN_ADDR_TYPE) == SCAN_ADDR_TYPE_BRIDGE));
1320 +}
1321 +
1322 +static void bcma_erom_skip_component(struct bcma_bus *bus, u32 **eromptr)
1323 +{
1324 + u32 ent;
1325 + while (1) {
1326 + ent = bcma_erom_get_ent(bus, eromptr);
1327 + if ((ent & SCAN_ER_VALID) &&
1328 + ((ent & SCAN_ER_TAG) == SCAN_ER_TAG_CI))
1329 + break;
1330 + if (ent == (SCAN_ER_TAG_END | SCAN_ER_VALID))
1331 + break;
1332 + }
1333 + bcma_erom_push_ent(eromptr);
1334 +}
1335 +
1336 +static s32 bcma_erom_get_mst_port(struct bcma_bus *bus, u32 **eromptr)
1337 +{
1338 + u32 ent = bcma_erom_get_ent(bus, eromptr);
1339 + if (!(ent & SCAN_ER_VALID))
1340 + return -ENOENT;
1341 + if ((ent & SCAN_ER_TAG) != SCAN_ER_TAG_MP)
1342 + return -ENOENT;
1343 + return ent;
1344 +}
1345 +
1346 +static s32 bcma_erom_get_addr_desc(struct bcma_bus *bus, u32 **eromptr,
1347 + u32 type, u8 port)
1348 +{
1349 + u32 addrl, addrh, sizel, sizeh = 0;
1350 + u32 size;
1351 +
1352 + u32 ent = bcma_erom_get_ent(bus, eromptr);
1353 + if ((!(ent & SCAN_ER_VALID)) ||
1354 + ((ent & SCAN_ER_TAGX) != SCAN_ER_TAG_ADDR) ||
1355 + ((ent & SCAN_ADDR_TYPE) != type) ||
1356 + (((ent & SCAN_ADDR_PORT) >> SCAN_ADDR_PORT_SHIFT) != port)) {
1357 + bcma_erom_push_ent(eromptr);
1358 + return -EINVAL;
1359 + }
1360 +
1361 + addrl = ent & SCAN_ADDR_ADDR;
1362 + if (ent & SCAN_ADDR_AG32)
1363 + addrh = bcma_erom_get_ent(bus, eromptr);
1364 + else
1365 + addrh = 0;
1366 +
1367 + if ((ent & SCAN_ADDR_SZ) == SCAN_ADDR_SZ_SZD) {
1368 + size = bcma_erom_get_ent(bus, eromptr);
1369 + sizel = size & SCAN_SIZE_SZ;
1370 + if (size & SCAN_SIZE_SG32)
1371 + sizeh = bcma_erom_get_ent(bus, eromptr);
1372 + } else
1373 + sizel = SCAN_ADDR_SZ_BASE <<
1374 + ((ent & SCAN_ADDR_SZ) >> SCAN_ADDR_SZ_SHIFT);
1375 +
1376 + return addrl;
1377 +}
1378 +
1379 +int bcma_bus_scan(struct bcma_bus *bus)
1380 +{
1381 + u32 erombase;
1382 + u32 __iomem *eromptr, *eromend;
1383 +
1384 + s32 cia, cib;
1385 + u8 ports[2], wrappers[2];
1386 +
1387 + s32 tmp;
1388 + u8 i, j;
1389 +
1390 + int err;
1391 +
1392 + INIT_LIST_HEAD(&bus->cores);
1393 + bus->nr_cores = 0;
1394 +
1395 + bcma_scan_switch_core(bus, BCMA_ADDR_BASE);
1396 +
1397 + tmp = bcma_scan_read32(bus, 0, BCMA_CC_ID);
1398 + bus->chipinfo.id = (tmp & BCMA_CC_ID_ID) >> BCMA_CC_ID_ID_SHIFT;
1399 + bus->chipinfo.rev = (tmp & BCMA_CC_ID_REV) >> BCMA_CC_ID_REV_SHIFT;
1400 + bus->chipinfo.pkg = (tmp & BCMA_CC_ID_PKG) >> BCMA_CC_ID_PKG_SHIFT;
1401 +
1402 + erombase = bcma_scan_read32(bus, 0, BCMA_CC_EROM);
1403 + eromptr = bus->mmio;
1404 + eromend = eromptr + BCMA_CORE_SIZE / sizeof(u32);
1405 +
1406 + bcma_scan_switch_core(bus, erombase);
1407 +
1408 + while (eromptr < eromend) {
1409 + struct bcma_device *core = kzalloc(sizeof(*core), GFP_KERNEL);
1410 + if (!core)
1411 + return -ENOMEM;
1412 + INIT_LIST_HEAD(&core->list);
1413 + core->bus = bus;
1414 +
1415 + /* get CIs */
1416 + cia = bcma_erom_get_ci(bus, &eromptr);
1417 + if (cia < 0) {
1418 + bcma_erom_push_ent(&eromptr);
1419 + if (bcma_erom_is_end(bus, &eromptr))
1420 + break;
1421 + err= -EILSEQ;
1422 + goto out;
1423 + }
1424 + cib = bcma_erom_get_ci(bus, &eromptr);
1425 + if (cib < 0) {
1426 + err= -EILSEQ;
1427 + goto out;
1428 + }
1429 +
1430 + /* parse CIs */
1431 + core->id.class = (cia & SCAN_CIA_CLASS) >> SCAN_CIA_CLASS_SHIFT;
1432 + core->id.id = (cia & SCAN_CIA_ID) >> SCAN_CIA_ID_SHIFT;
1433 + core->id.manuf = (cia & SCAN_CIA_MANUF) >> SCAN_CIA_MANUF_SHIFT;
1434 + ports[0] = (cib & SCAN_CIB_NMP) >> SCAN_CIB_NMP_SHIFT;
1435 + ports[1] = (cib & SCAN_CIB_NSP) >> SCAN_CIB_NSP_SHIFT;
1436 + wrappers[0] = (cib & SCAN_CIB_NMW) >> SCAN_CIB_NMW_SHIFT;
1437 + wrappers[1] = (cib & SCAN_CIB_NSW) >> SCAN_CIB_NSW_SHIFT;
1438 + core->id.rev = (cib & SCAN_CIB_REV) >> SCAN_CIB_REV_SHIFT;
1439 +
1440 + if (((core->id.manuf == BCMA_MANUF_ARM) &&
1441 + (core->id.id == 0xFFF)) ||
1442 + (ports[1] == 0)) {
1443 + bcma_erom_skip_component(bus, &eromptr);
1444 + continue;
1445 + }
1446 +
1447 + /* check if component is a core at all */
1448 + if (wrappers[0] + wrappers[1] == 0) {
1449 + /* we could save addrl of the router
1450 + if (cid == BCMA_CORE_OOB_ROUTER)
1451 + */
1452 + bcma_erom_skip_component(bus, &eromptr);
1453 + continue;
1454 + }
1455 +
1456 + if (bcma_erom_is_bridge(bus, &eromptr)) {
1457 + bcma_erom_skip_component(bus, &eromptr);
1458 + continue;
1459 + }
1460 +
1461 + /* get & parse master ports */
1462 + for (i = 0; i < ports[0]; i++) {
1463 + u32 mst_port_d = bcma_erom_get_mst_port(bus, &eromptr);
1464 + if (mst_port_d < 0) {
1465 + err= -EILSEQ;
1466 + goto out;
1467 + }
1468 + }
1469 +
1470 + /* get & parse slave ports */
1471 + for (i = 0; i < ports[1]; i++) {
1472 + for (j = 0; ; j++) {
1473 + tmp = bcma_erom_get_addr_desc(bus, &eromptr,
1474 + SCAN_ADDR_TYPE_SLAVE, i);
1475 + if (tmp < 0) {
1476 + /* no more entries for port _i_ */
1477 + /* pr_debug("erom: slave port %d "
1478 + * "has %d descriptors\n", i, j); */
1479 + break;
1480 + } else {
1481 + if (i == 0 && j == 0)
1482 + core->addr = tmp;
1483 + }
1484 + }
1485 + }
1486 +
1487 + /* get & parse master wrappers */
1488 + for (i = 0; i < wrappers[0]; i++) {
1489 + for (j = 0; ; j++) {
1490 + tmp = bcma_erom_get_addr_desc(bus, &eromptr,
1491 + SCAN_ADDR_TYPE_MWRAP, i);
1492 + if (tmp < 0) {
1493 + /* no more entries for port _i_ */
1494 + /* pr_debug("erom: master wrapper %d "
1495 + * "has %d descriptors\n", i, j); */
1496 + break;
1497 + } else {
1498 + if (i == 0 && j == 0)
1499 + core->wrap = tmp;
1500 + }
1501 + }
1502 + }
1503 +
1504 + /* get & parse slave wrappers */
1505 + for (i = 0; i < wrappers[1]; i++) {
1506 + u8 hack = (ports[1] == 1) ? 0 : 1;
1507 + for (j = 0; ; j++) {
1508 + tmp = bcma_erom_get_addr_desc(bus, &eromptr,
1509 + SCAN_ADDR_TYPE_SWRAP, i + hack);
1510 + if (tmp < 0) {
1511 + /* no more entries for port _i_ */
1512 + /* pr_debug("erom: master wrapper %d "
1513 + * has %d descriptors\n", i, j); */
1514 + break;
1515 + } else {
1516 + if (wrappers[0] == 0 && !i && !j)
1517 + core->wrap = tmp;
1518 + }
1519 + }
1520 + }
1521 +
1522 + pr_info("Core %d found: %s "
1523 + "(manuf 0x%03X, id 0x%03X, rev 0x%02X, class 0x%X)\n",
1524 + bus->nr_cores, bcma_device_name(&core->id),
1525 + core->id.manuf, core->id.id, core->id.rev,
1526 + core->id.class);
1527 +
1528 + core->core_index = bus->nr_cores++;
1529 + list_add(&core->list, &bus->cores);
1530 + continue;
1531 +out:
1532 + return err;
1533 + }
1534 +
1535 + return 0;
1536 +}
1537 --- /dev/null
1538 +++ b/drivers/bcma/scan.h
1539 @@ -0,0 +1,56 @@
1540 +#ifndef BCMA_SCAN_H_
1541 +#define BCMA_SCAN_H_
1542 +
1543 +#define BCMA_ADDR_BASE 0x18000000
1544 +#define BCMA_WRAP_BASE 0x18100000
1545 +
1546 +#define SCAN_ER_VALID 0x00000001
1547 +#define SCAN_ER_TAGX 0x00000006 /* we have to ignore 0x8 bit when checking tag for SCAN_ER_TAG_ADDR */
1548 +#define SCAN_ER_TAG 0x0000000E
1549 +#define SCAN_ER_TAG_CI 0x00000000
1550 +#define SCAN_ER_TAG_MP 0x00000002
1551 +#define SCAN_ER_TAG_ADDR 0x00000004
1552 +#define SCAN_ER_TAG_END 0x0000000E
1553 +#define SCAN_ER_BAD 0xFFFFFFFF
1554 +
1555 +#define SCAN_CIA_CLASS 0x000000F0
1556 +#define SCAN_CIA_CLASS_SHIFT 4
1557 +#define SCAN_CIA_ID 0x000FFF00
1558 +#define SCAN_CIA_ID_SHIFT 8
1559 +#define SCAN_CIA_MANUF 0xFFF00000
1560 +#define SCAN_CIA_MANUF_SHIFT 20
1561 +
1562 +#define SCAN_CIB_NMP 0x000001F0
1563 +#define SCAN_CIB_NMP_SHIFT 4
1564 +#define SCAN_CIB_NSP 0x00003E00
1565 +#define SCAN_CIB_NSP_SHIFT 9
1566 +#define SCAN_CIB_NMW 0x0007C000
1567 +#define SCAN_CIB_NMW_SHIFT 14
1568 +#define SCAN_CIB_NSW 0x00F80000
1569 +#define SCAN_CIB_NSW_SHIFT 17
1570 +#define SCAN_CIB_REV 0xFF000000
1571 +#define SCAN_CIB_REV_SHIFT 24
1572 +
1573 +#define SCAN_ADDR_AG32 0x00000008
1574 +#define SCAN_ADDR_SZ 0x00000030
1575 +#define SCAN_ADDR_SZ_SHIFT 4
1576 +#define SCAN_ADDR_SZ_4K 0x00000000
1577 +#define SCAN_ADDR_SZ_8K 0x00000010
1578 +#define SCAN_ADDR_SZ_16K 0x00000020
1579 +#define SCAN_ADDR_SZ_SZD 0x00000030
1580 +#define SCAN_ADDR_TYPE 0x000000C0
1581 +#define SCAN_ADDR_TYPE_SLAVE 0x00000000
1582 +#define SCAN_ADDR_TYPE_BRIDGE 0x00000040
1583 +#define SCAN_ADDR_TYPE_SWRAP 0x00000080
1584 +#define SCAN_ADDR_TYPE_MWRAP 0x000000C0
1585 +#define SCAN_ADDR_PORT 0x00000F00
1586 +#define SCAN_ADDR_PORT_SHIFT 8
1587 +#define SCAN_ADDR_ADDR 0xFFFFF000
1588 +
1589 +#define SCAN_ADDR_SZ_BASE 0x00001000 /* 4KB */
1590 +
1591 +#define SCAN_SIZE_SZ_ALIGN 0x00000FFF
1592 +#define SCAN_SIZE_SZ 0xFFFFF000
1593 +#define SCAN_SIZE_SG32 0x00000008
1594 +
1595 +#endif /* BCMA_SCAN_H_ */
1596 --- /dev/null
1597 +++ b/include/linux/bcma/bcma.h
1598 @@ -0,0 +1,250 @@
1599 +#ifndef LINUX_BCMA_H_
1600 +#define LINUX_BCMA_H_
1601 +
1602 +#include <linux/pci.h>
1603 +#include <linux/mod_devicetable.h>
1604 +
1605 +#include <linux/bcma/bcma_driver_chipcommon.h>
1606 +#include <linux/bcma/bcma_driver_pci.h>
1607 +#include <linux/ssb/ssb.h> /* SPROM sharing */
1608 +
1609 +#include "bcma_regs.h"
1610 +
1611 +struct bcma_device;
1612 +struct bcma_bus;
1613 +
1614 +enum bcma_hosttype {
1615 + BCMA_HOSTTYPE_NONE,
1616 + BCMA_HOSTTYPE_PCI,
1617 + BCMA_HOSTTYPE_SDIO,
1618 +};
1619 +
1620 +struct bcma_chipinfo {
1621 + u16 id;
1622 + u8 rev;
1623 + u8 pkg;
1624 +};
1625 +
1626 +struct bcma_host_ops {
1627 + u8 (*read8)(struct bcma_device *core, u16 offset);
1628 + u16 (*read16)(struct bcma_device *core, u16 offset);
1629 + u32 (*read32)(struct bcma_device *core, u16 offset);
1630 + void (*write8)(struct bcma_device *core, u16 offset, u8 value);
1631 + void (*write16)(struct bcma_device *core, u16 offset, u16 value);
1632 + void (*write32)(struct bcma_device *core, u16 offset, u32 value);
1633 +#ifdef CONFIG_BCMA_BLOCKIO
1634 + void (*block_read)(struct bcma_device *core, void *buffer,
1635 + size_t count, u16 offset, u8 reg_width);
1636 + void (*block_write)(struct bcma_device *core, const void *buffer,
1637 + size_t count, u16 offset, u8 reg_width);
1638 +#endif
1639 + /* Agent ops */
1640 + u32 (*aread32)(struct bcma_device *core, u16 offset);
1641 + void (*awrite32)(struct bcma_device *core, u16 offset, u32 value);
1642 +};
1643 +
1644 +/* Core manufacturers */
1645 +#define BCMA_MANUF_ARM 0x43B
1646 +#define BCMA_MANUF_MIPS 0x4A7
1647 +#define BCMA_MANUF_BCM 0x4BF
1648 +
1649 +/* Core class values. */
1650 +#define BCMA_CL_SIM 0x0
1651 +#define BCMA_CL_EROM 0x1
1652 +#define BCMA_CL_CORESIGHT 0x9
1653 +#define BCMA_CL_VERIF 0xB
1654 +#define BCMA_CL_OPTIMO 0xD
1655 +#define BCMA_CL_GEN 0xE
1656 +#define BCMA_CL_PRIMECELL 0xF
1657 +
1658 +/* Core-ID values. */
1659 +#define BCMA_CORE_OOB_ROUTER 0x367 /* Out of band */
1660 +#define BCMA_CORE_INVALID 0x700
1661 +#define BCMA_CORE_CHIPCOMMON 0x800
1662 +#define BCMA_CORE_ILINE20 0x801
1663 +#define BCMA_CORE_SRAM 0x802
1664 +#define BCMA_CORE_SDRAM 0x803
1665 +#define BCMA_CORE_PCI 0x804
1666 +#define BCMA_CORE_MIPS 0x805
1667 +#define BCMA_CORE_ETHERNET 0x806
1668 +#define BCMA_CORE_V90 0x807
1669 +#define BCMA_CORE_USB11_HOSTDEV 0x808
1670 +#define BCMA_CORE_ADSL 0x809
1671 +#define BCMA_CORE_ILINE100 0x80A
1672 +#define BCMA_CORE_IPSEC 0x80B
1673 +#define BCMA_CORE_UTOPIA 0x80C
1674 +#define BCMA_CORE_PCMCIA 0x80D
1675 +#define BCMA_CORE_INTERNAL_MEM 0x80E
1676 +#define BCMA_CORE_MEMC_SDRAM 0x80F
1677 +#define BCMA_CORE_OFDM 0x810
1678 +#define BCMA_CORE_EXTIF 0x811
1679 +#define BCMA_CORE_80211 0x812
1680 +#define BCMA_CORE_PHY_A 0x813
1681 +#define BCMA_CORE_PHY_B 0x814
1682 +#define BCMA_CORE_PHY_G 0x815
1683 +#define BCMA_CORE_MIPS_3302 0x816
1684 +#define BCMA_CORE_USB11_HOST 0x817
1685 +#define BCMA_CORE_USB11_DEV 0x818
1686 +#define BCMA_CORE_USB20_HOST 0x819
1687 +#define BCMA_CORE_USB20_DEV 0x81A
1688 +#define BCMA_CORE_SDIO_HOST 0x81B
1689 +#define BCMA_CORE_ROBOSWITCH 0x81C
1690 +#define BCMA_CORE_PARA_ATA 0x81D
1691 +#define BCMA_CORE_SATA_XORDMA 0x81E
1692 +#define BCMA_CORE_ETHERNET_GBIT 0x81F
1693 +#define BCMA_CORE_PCIE 0x820
1694 +#define BCMA_CORE_PHY_N 0x821
1695 +#define BCMA_CORE_SRAM_CTL 0x822
1696 +#define BCMA_CORE_MINI_MACPHY 0x823
1697 +#define BCMA_CORE_ARM_1176 0x824
1698 +#define BCMA_CORE_ARM_7TDMI 0x825
1699 +#define BCMA_CORE_PHY_LP 0x826
1700 +#define BCMA_CORE_PMU 0x827
1701 +#define BCMA_CORE_PHY_SSN 0x828
1702 +#define BCMA_CORE_SDIO_DEV 0x829
1703 +#define BCMA_CORE_ARM_CM3 0x82A
1704 +#define BCMA_CORE_PHY_HT 0x82B
1705 +#define BCMA_CORE_MIPS_74K 0x82C
1706 +#define BCMA_CORE_MAC_GBIT 0x82D
1707 +#define BCMA_CORE_DDR12_MEM_CTL 0x82E
1708 +#define BCMA_CORE_PCIE_RC 0x82F /* PCIe Root Complex */
1709 +#define BCMA_CORE_OCP_OCP_BRIDGE 0x830
1710 +#define BCMA_CORE_SHARED_COMMON 0x831
1711 +#define BCMA_CORE_OCP_AHB_BRIDGE 0x832
1712 +#define BCMA_CORE_SPI_HOST 0x833
1713 +#define BCMA_CORE_I2S 0x834
1714 +#define BCMA_CORE_SDR_DDR1_MEM_CTL 0x835 /* SDR/DDR1 memory controller core */
1715 +#define BCMA_CORE_SHIM 0x837 /* SHIM component in ubus/6362 */
1716 +#define BCMA_CORE_DEFAULT 0xFFF
1717 +
1718 +#define BCMA_MAX_NR_CORES 16
1719 +
1720 +struct bcma_device {
1721 + struct bcma_bus *bus;
1722 + struct bcma_device_id id;
1723 +
1724 + struct device dev;
1725 + struct device *dma_dev;
1726 + unsigned int irq;
1727 + bool dev_registered;
1728 +
1729 + u8 core_index;
1730 +
1731 + u32 addr;
1732 + u32 wrap;
1733 +
1734 + void *drvdata;
1735 + struct list_head list;
1736 +};
1737 +
1738 +static inline void *bcma_get_drvdata(struct bcma_device *core)
1739 +{
1740 + return core->drvdata;
1741 +}
1742 +static inline void bcma_set_drvdata(struct bcma_device *core, void *drvdata)
1743 +{
1744 + core->drvdata = drvdata;
1745 +}
1746 +
1747 +struct bcma_driver {
1748 + const char *name;
1749 + const struct bcma_device_id *id_table;
1750 +
1751 + int (*probe)(struct bcma_device *dev);
1752 + void (*remove)(struct bcma_device *dev);
1753 + int (*suspend)(struct bcma_device *dev, pm_message_t state);
1754 + int (*resume)(struct bcma_device *dev);
1755 + void (*shutdown)(struct bcma_device *dev);
1756 +
1757 + struct device_driver drv;
1758 +};
1759 +extern
1760 +int __bcma_driver_register(struct bcma_driver *drv, struct module *owner);
1761 +static inline int bcma_driver_register(struct bcma_driver *drv)
1762 +{
1763 + return __bcma_driver_register(drv, THIS_MODULE);
1764 +}
1765 +extern void bcma_driver_unregister(struct bcma_driver *drv);
1766 +
1767 +struct bcma_bus {
1768 + /* The MMIO area. */
1769 + void __iomem *mmio;
1770 +
1771 + const struct bcma_host_ops *ops;
1772 +
1773 + enum bcma_hosttype hosttype;
1774 + union {
1775 + /* Pointer to the PCI bus (only for BCMA_HOSTTYPE_PCI) */
1776 + struct pci_dev *host_pci;
1777 + /* Pointer to the SDIO device (only for BCMA_HOSTTYPE_SDIO) */
1778 + struct sdio_func *host_sdio;
1779 + };
1780 +
1781 + struct bcma_chipinfo chipinfo;
1782 +
1783 + struct bcma_device *mapped_core;
1784 + struct list_head cores;
1785 + u8 nr_cores;
1786 +
1787 + struct bcma_drv_cc drv_cc;
1788 + struct bcma_drv_pci drv_pci;
1789 +
1790 + /* We decided to share SPROM struct with SSB as long as we do not need
1791 + * any hacks for BCMA. This simplifies drivers code. */
1792 + struct ssb_sprom sprom;
1793 +};
1794 +
1795 +extern inline u32 bcma_read8(struct bcma_device *core, u16 offset)
1796 +{
1797 + return core->bus->ops->read8(core, offset);
1798 +}
1799 +extern inline u32 bcma_read16(struct bcma_device *core, u16 offset)
1800 +{
1801 + return core->bus->ops->read16(core, offset);
1802 +}
1803 +extern inline u32 bcma_read32(struct bcma_device *core, u16 offset)
1804 +{
1805 + return core->bus->ops->read32(core, offset);
1806 +}
1807 +extern inline
1808 +void bcma_write8(struct bcma_device *core, u16 offset, u32 value)
1809 +{
1810 + core->bus->ops->write8(core, offset, value);
1811 +}
1812 +extern inline
1813 +void bcma_write16(struct bcma_device *core, u16 offset, u32 value)
1814 +{
1815 + core->bus->ops->write16(core, offset, value);
1816 +}
1817 +extern inline
1818 +void bcma_write32(struct bcma_device *core, u16 offset, u32 value)
1819 +{
1820 + core->bus->ops->write32(core, offset, value);
1821 +}
1822 +#ifdef CONFIG_BCMA_BLOCKIO
1823 +extern inline void bcma_block_read(struct bcma_device *core, void *buffer,
1824 + size_t count, u16 offset, u8 reg_width)
1825 +{
1826 + core->bus->ops->block_read(core, buffer, count, offset, reg_width);
1827 +}
1828 +extern inline void bcma_block_write(struct bcma_device *core, const void *buffer,
1829 + size_t count, u16 offset, u8 reg_width)
1830 +{
1831 + core->bus->ops->block_write(core, buffer, count, offset, reg_width);
1832 +}
1833 +#endif
1834 +extern inline u32 bcma_aread32(struct bcma_device *core, u16 offset)
1835 +{
1836 + return core->bus->ops->aread32(core, offset);
1837 +}
1838 +extern inline
1839 +void bcma_awrite32(struct bcma_device *core, u16 offset, u32 value)
1840 +{
1841 + core->bus->ops->awrite32(core, offset, value);
1842 +}
1843 +
1844 +extern bool bcma_core_is_enabled(struct bcma_device *core);
1845 +extern void bcma_core_disable(struct bcma_device *core, u32 flags);
1846 +extern int bcma_core_enable(struct bcma_device *core, u32 flags);
1847 +
1848 +#endif /* LINUX_BCMA_H_ */
1849 --- /dev/null
1850 +++ b/include/linux/bcma/bcma_driver_chipcommon.h
1851 @@ -0,0 +1,303 @@
1852 +#ifndef LINUX_BCMA_DRIVER_CC_H_
1853 +#define LINUX_BCMA_DRIVER_CC_H_
1854 +
1855 +/** ChipCommon core registers. **/
1856 +#define BCMA_CC_ID 0x0000
1857 +#define BCMA_CC_ID_ID 0x0000FFFF
1858 +#define BCMA_CC_ID_ID_SHIFT 0
1859 +#define BCMA_CC_ID_REV 0x000F0000
1860 +#define BCMA_CC_ID_REV_SHIFT 16
1861 +#define BCMA_CC_ID_PKG 0x00F00000
1862 +#define BCMA_CC_ID_PKG_SHIFT 20
1863 +#define BCMA_CC_ID_NRCORES 0x0F000000
1864 +#define BCMA_CC_ID_NRCORES_SHIFT 24
1865 +#define BCMA_CC_ID_TYPE 0xF0000000
1866 +#define BCMA_CC_ID_TYPE_SHIFT 28
1867 +#define BCMA_CC_CAP 0x0004 /* Capabilities */
1868 +#define BCMA_CC_CAP_NRUART 0x00000003 /* # of UARTs */
1869 +#define BCMA_CC_CAP_MIPSEB 0x00000004 /* MIPS in BigEndian Mode */
1870 +#define BCMA_CC_CAP_UARTCLK 0x00000018 /* UART clock select */
1871 +#define BCMA_CC_CAP_UARTCLK_INT 0x00000008 /* UARTs are driven by internal divided clock */
1872 +#define BCMA_CC_CAP_UARTGPIO 0x00000020 /* UARTs on GPIO 15-12 */
1873 +#define BCMA_CC_CAP_EXTBUS 0x000000C0 /* External buses present */
1874 +#define BCMA_CC_CAP_FLASHT 0x00000700 /* Flash Type */
1875 +#define BCMA_CC_FLASHT_NONE 0x00000000 /* No flash */
1876 +#define BCMA_CC_FLASHT_STSER 0x00000100 /* ST serial flash */
1877 +#define BCMA_CC_FLASHT_ATSER 0x00000200 /* Atmel serial flash */
1878 +#define BCMA_CC_FLASHT_PARA 0x00000700 /* Parallel flash */
1879 +#define BCMA_CC_CAP_PLLT 0x00038000 /* PLL Type */
1880 +#define BCMA_PLLTYPE_NONE 0x00000000
1881 +#define BCMA_PLLTYPE_1 0x00010000 /* 48Mhz base, 3 dividers */
1882 +#define BCMA_PLLTYPE_2 0x00020000 /* 48Mhz, 4 dividers */
1883 +#define BCMA_PLLTYPE_3 0x00030000 /* 25Mhz, 2 dividers */
1884 +#define BCMA_PLLTYPE_4 0x00008000 /* 48Mhz, 4 dividers */
1885 +#define BCMA_PLLTYPE_5 0x00018000 /* 25Mhz, 4 dividers */
1886 +#define BCMA_PLLTYPE_6 0x00028000 /* 100/200 or 120/240 only */
1887 +#define BCMA_PLLTYPE_7 0x00038000 /* 25Mhz, 4 dividers */
1888 +#define BCMA_CC_CAP_PCTL 0x00040000 /* Power Control */
1889 +#define BCMA_CC_CAP_OTPS 0x00380000 /* OTP size */
1890 +#define BCMA_CC_CAP_OTPS_SHIFT 19
1891 +#define BCMA_CC_CAP_OTPS_BASE 5
1892 +#define BCMA_CC_CAP_JTAGM 0x00400000 /* JTAG master present */
1893 +#define BCMA_CC_CAP_BROM 0x00800000 /* Internal boot ROM active */
1894 +#define BCMA_CC_CAP_64BIT 0x08000000 /* 64-bit Backplane */
1895 +#define BCMA_CC_CAP_PMU 0x10000000 /* PMU available (rev >= 20) */
1896 +#define BCMA_CC_CAP_ECI 0x20000000 /* ECI available (rev >= 20) */
1897 +#define BCMA_CC_CAP_SPROM 0x40000000 /* SPROM present */
1898 +#define BCMA_CC_CORECTL 0x0008
1899 +#define BCMA_CC_CORECTL_UARTCLK0 0x00000001 /* Drive UART with internal clock */
1900 +#define BCMA_CC_CORECTL_SE 0x00000002 /* sync clk out enable (corerev >= 3) */
1901 +#define BCMA_CC_CORECTL_UARTCLKEN 0x00000008 /* UART clock enable (rev >= 21) */
1902 +#define BCMA_CC_BIST 0x000C
1903 +#define BCMA_CC_OTPS 0x0010 /* OTP status */
1904 +#define BCMA_CC_OTPS_PROGFAIL 0x80000000
1905 +#define BCMA_CC_OTPS_PROTECT 0x00000007
1906 +#define BCMA_CC_OTPS_HW_PROTECT 0x00000001
1907 +#define BCMA_CC_OTPS_SW_PROTECT 0x00000002
1908 +#define BCMA_CC_OTPS_CID_PROTECT 0x00000004
1909 +#define BCMA_CC_OTPC 0x0014 /* OTP control */
1910 +#define BCMA_CC_OTPC_RECWAIT 0xFF000000
1911 +#define BCMA_CC_OTPC_PROGWAIT 0x00FFFF00
1912 +#define BCMA_CC_OTPC_PRW_SHIFT 8
1913 +#define BCMA_CC_OTPC_MAXFAIL 0x00000038
1914 +#define BCMA_CC_OTPC_VSEL 0x00000006
1915 +#define BCMA_CC_OTPC_SELVL 0x00000001
1916 +#define BCMA_CC_OTPP 0x0018 /* OTP prog */
1917 +#define BCMA_CC_OTPP_COL 0x000000FF
1918 +#define BCMA_CC_OTPP_ROW 0x0000FF00
1919 +#define BCMA_CC_OTPP_ROW_SHIFT 8
1920 +#define BCMA_CC_OTPP_READERR 0x10000000
1921 +#define BCMA_CC_OTPP_VALUE 0x20000000
1922 +#define BCMA_CC_OTPP_READ 0x40000000
1923 +#define BCMA_CC_OTPP_START 0x80000000
1924 +#define BCMA_CC_OTPP_BUSY 0x80000000
1925 +#define BCMA_CC_IRQSTAT 0x0020
1926 +#define BCMA_CC_IRQMASK 0x0024
1927 +#define BCMA_CC_IRQ_GPIO 0x00000001 /* gpio intr */
1928 +#define BCMA_CC_IRQ_EXT 0x00000002 /* ro: ext intr pin (corerev >= 3) */
1929 +#define BCMA_CC_IRQ_WDRESET 0x80000000 /* watchdog reset occurred */
1930 +#define BCMA_CC_CHIPCTL 0x0028 /* Rev >= 11 only */
1931 +#define BCMA_CC_CHIPSTAT 0x002C /* Rev >= 11 only */
1932 +#define BCMA_CC_JCMD 0x0030 /* Rev >= 10 only */
1933 +#define BCMA_CC_JCMD_START 0x80000000
1934 +#define BCMA_CC_JCMD_BUSY 0x80000000
1935 +#define BCMA_CC_JCMD_PAUSE 0x40000000
1936 +#define BCMA_CC_JCMD0_ACC_MASK 0x0000F000
1937 +#define BCMA_CC_JCMD0_ACC_IRDR 0x00000000
1938 +#define BCMA_CC_JCMD0_ACC_DR 0x00001000
1939 +#define BCMA_CC_JCMD0_ACC_IR 0x00002000
1940 +#define BCMA_CC_JCMD0_ACC_RESET 0x00003000
1941 +#define BCMA_CC_JCMD0_ACC_IRPDR 0x00004000
1942 +#define BCMA_CC_JCMD0_ACC_PDR 0x00005000
1943 +#define BCMA_CC_JCMD0_IRW_MASK 0x00000F00
1944 +#define BCMA_CC_JCMD_ACC_MASK 0x000F0000 /* Changes for corerev 11 */
1945 +#define BCMA_CC_JCMD_ACC_IRDR 0x00000000
1946 +#define BCMA_CC_JCMD_ACC_DR 0x00010000
1947 +#define BCMA_CC_JCMD_ACC_IR 0x00020000
1948 +#define BCMA_CC_JCMD_ACC_RESET 0x00030000
1949 +#define BCMA_CC_JCMD_ACC_IRPDR 0x00040000
1950 +#define BCMA_CC_JCMD_ACC_PDR 0x00050000
1951 +#define BCMA_CC_JCMD_IRW_MASK 0x00001F00
1952 +#define BCMA_CC_JCMD_IRW_SHIFT 8
1953 +#define BCMA_CC_JCMD_DRW_MASK 0x0000003F
1954 +#define BCMA_CC_JIR 0x0034 /* Rev >= 10 only */
1955 +#define BCMA_CC_JDR 0x0038 /* Rev >= 10 only */
1956 +#define BCMA_CC_JCTL 0x003C /* Rev >= 10 only */
1957 +#define BCMA_CC_JCTL_FORCE_CLK 4 /* Force clock */
1958 +#define BCMA_CC_JCTL_EXT_EN 2 /* Enable external targets */
1959 +#define BCMA_CC_JCTL_EN 1 /* Enable Jtag master */
1960 +#define BCMA_CC_FLASHCTL 0x0040
1961 +#define BCMA_CC_FLASHCTL_START 0x80000000
1962 +#define BCMA_CC_FLASHCTL_BUSY BCMA_CC_FLASHCTL_START
1963 +#define BCMA_CC_FLASHADDR 0x0044
1964 +#define BCMA_CC_FLASHDATA 0x0048
1965 +#define BCMA_CC_BCAST_ADDR 0x0050
1966 +#define BCMA_CC_BCAST_DATA 0x0054
1967 +#define BCMA_CC_GPIOPULLUP 0x0058 /* Rev >= 20 only */
1968 +#define BCMA_CC_GPIOPULLDOWN 0x005C /* Rev >= 20 only */
1969 +#define BCMA_CC_GPIOIN 0x0060
1970 +#define BCMA_CC_GPIOOUT 0x0064
1971 +#define BCMA_CC_GPIOOUTEN 0x0068
1972 +#define BCMA_CC_GPIOCTL 0x006C
1973 +#define BCMA_CC_GPIOPOL 0x0070
1974 +#define BCMA_CC_GPIOIRQ 0x0074
1975 +#define BCMA_CC_WATCHDOG 0x0080
1976 +#define BCMA_CC_GPIOTIMER 0x0088 /* LED powersave (corerev >= 16) */
1977 +#define BCMA_CC_GPIOTIMER_OFFTIME 0x0000FFFF
1978 +#define BCMA_CC_GPIOTIMER_OFFTIME_SHIFT 0
1979 +#define BCMA_CC_GPIOTIMER_ONTIME 0xFFFF0000
1980 +#define BCMA_CC_GPIOTIMER_ONTIME_SHIFT 16
1981 +#define BCMA_CC_GPIOTOUTM 0x008C /* LED powersave (corerev >= 16) */
1982 +#define BCMA_CC_CLOCK_N 0x0090
1983 +#define BCMA_CC_CLOCK_SB 0x0094
1984 +#define BCMA_CC_CLOCK_PCI 0x0098
1985 +#define BCMA_CC_CLOCK_M2 0x009C
1986 +#define BCMA_CC_CLOCK_MIPS 0x00A0
1987 +#define BCMA_CC_CLKDIV 0x00A4 /* Rev >= 3 only */
1988 +#define BCMA_CC_CLKDIV_SFLASH 0x0F000000
1989 +#define BCMA_CC_CLKDIV_SFLASH_SHIFT 24
1990 +#define BCMA_CC_CLKDIV_OTP 0x000F0000
1991 +#define BCMA_CC_CLKDIV_OTP_SHIFT 16
1992 +#define BCMA_CC_CLKDIV_JTAG 0x00000F00
1993 +#define BCMA_CC_CLKDIV_JTAG_SHIFT 8
1994 +#define BCMA_CC_CLKDIV_UART 0x000000FF
1995 +#define BCMA_CC_CAP_EXT 0x00AC /* Capabilities */
1996 +#define BCMA_CC_PLLONDELAY 0x00B0 /* Rev >= 4 only */
1997 +#define BCMA_CC_FREFSELDELAY 0x00B4 /* Rev >= 4 only */
1998 +#define BCMA_CC_SLOWCLKCTL 0x00B8 /* 6 <= Rev <= 9 only */
1999 +#define BCMA_CC_SLOWCLKCTL_SRC 0x00000007 /* slow clock source mask */
2000 +#define BCMA_CC_SLOWCLKCTL_SRC_LPO 0x00000000 /* source of slow clock is LPO */
2001 +#define BCMA_CC_SLOWCLKCTL_SRC_XTAL 0x00000001 /* source of slow clock is crystal */
2002 +#define BCMA_CC_SLOECLKCTL_SRC_PCI 0x00000002 /* source of slow clock is PCI */
2003 +#define BCMA_CC_SLOWCLKCTL_LPOFREQ 0x00000200 /* LPOFreqSel, 1: 160Khz, 0: 32KHz */
2004 +#define BCMA_CC_SLOWCLKCTL_LPOPD 0x00000400 /* LPOPowerDown, 1: LPO is disabled, 0: LPO is enabled */
2005 +#define BCMA_CC_SLOWCLKCTL_FSLOW 0x00000800 /* ForceSlowClk, 1: sb/cores running on slow clock, 0: power logic control */
2006 +#define BCMA_CC_SLOWCLKCTL_IPLL 0x00001000 /* IgnorePllOffReq, 1/0: power logic ignores/honors PLL clock disable requests from core */
2007 +#define BCMA_CC_SLOWCLKCTL_ENXTAL 0x00002000 /* XtalControlEn, 1/0: power logic does/doesn't disable crystal when appropriate */
2008 +#define BCMA_CC_SLOWCLKCTL_XTALPU 0x00004000 /* XtalPU (RO), 1/0: crystal running/disabled */
2009 +#define BCMA_CC_SLOWCLKCTL_CLKDIV 0xFFFF0000 /* ClockDivider (SlowClk = 1/(4+divisor)) */
2010 +#define BCMA_CC_SLOWCLKCTL_CLKDIV_SHIFT 16
2011 +#define BCMA_CC_SYSCLKCTL 0x00C0 /* Rev >= 3 only */
2012 +#define BCMA_CC_SYSCLKCTL_IDLPEN 0x00000001 /* ILPen: Enable Idle Low Power */
2013 +#define BCMA_CC_SYSCLKCTL_ALPEN 0x00000002 /* ALPen: Enable Active Low Power */
2014 +#define BCMA_CC_SYSCLKCTL_PLLEN 0x00000004 /* ForcePLLOn */
2015 +#define BCMA_CC_SYSCLKCTL_FORCEALP 0x00000008 /* Force ALP (or HT if ALPen is not set */
2016 +#define BCMA_CC_SYSCLKCTL_FORCEHT 0x00000010 /* Force HT */
2017 +#define BCMA_CC_SYSCLKCTL_CLKDIV 0xFFFF0000 /* ClkDiv (ILP = 1/(4+divisor)) */
2018 +#define BCMA_CC_SYSCLKCTL_CLKDIV_SHIFT 16
2019 +#define BCMA_CC_CLKSTSTR 0x00C4 /* Rev >= 3 only */
2020 +#define BCMA_CC_EROM 0x00FC
2021 +#define BCMA_CC_PCMCIA_CFG 0x0100
2022 +#define BCMA_CC_PCMCIA_MEMWAIT 0x0104
2023 +#define BCMA_CC_PCMCIA_ATTRWAIT 0x0108
2024 +#define BCMA_CC_PCMCIA_IOWAIT 0x010C
2025 +#define BCMA_CC_IDE_CFG 0x0110
2026 +#define BCMA_CC_IDE_MEMWAIT 0x0114
2027 +#define BCMA_CC_IDE_ATTRWAIT 0x0118
2028 +#define BCMA_CC_IDE_IOWAIT 0x011C
2029 +#define BCMA_CC_PROG_CFG 0x0120
2030 +#define BCMA_CC_PROG_WAITCNT 0x0124
2031 +#define BCMA_CC_FLASH_CFG 0x0128
2032 +#define BCMA_CC_FLASH_WAITCNT 0x012C
2033 +#define BCMA_CC_CLKCTLST 0x01E0 /* Clock control and status (rev >= 20) */
2034 +#define BCMA_CC_CLKCTLST_FORCEALP 0x00000001 /* Force ALP request */
2035 +#define BCMA_CC_CLKCTLST_FORCEHT 0x00000002 /* Force HT request */
2036 +#define BCMA_CC_CLKCTLST_FORCEILP 0x00000004 /* Force ILP request */
2037 +#define BCMA_CC_CLKCTLST_HAVEALPREQ 0x00000008 /* ALP available request */
2038 +#define BCMA_CC_CLKCTLST_HAVEHTREQ 0x00000010 /* HT available request */
2039 +#define BCMA_CC_CLKCTLST_HWCROFF 0x00000020 /* Force HW clock request off */
2040 +#define BCMA_CC_CLKCTLST_HAVEHT 0x00010000 /* HT available */
2041 +#define BCMA_CC_CLKCTLST_HAVEALP 0x00020000 /* APL available */
2042 +#define BCMA_CC_HW_WORKAROUND 0x01E4 /* Hardware workaround (rev >= 20) */
2043 +#define BCMA_CC_UART0_DATA 0x0300
2044 +#define BCMA_CC_UART0_IMR 0x0304
2045 +#define BCMA_CC_UART0_FCR 0x0308
2046 +#define BCMA_CC_UART0_LCR 0x030C
2047 +#define BCMA_CC_UART0_MCR 0x0310
2048 +#define BCMA_CC_UART0_LSR 0x0314
2049 +#define BCMA_CC_UART0_MSR 0x0318
2050 +#define BCMA_CC_UART0_SCRATCH 0x031C
2051 +#define BCMA_CC_UART1_DATA 0x0400
2052 +#define BCMA_CC_UART1_IMR 0x0404
2053 +#define BCMA_CC_UART1_FCR 0x0408
2054 +#define BCMA_CC_UART1_LCR 0x040C
2055 +#define BCMA_CC_UART1_MCR 0x0410
2056 +#define BCMA_CC_UART1_LSR 0x0414
2057 +#define BCMA_CC_UART1_MSR 0x0418
2058 +#define BCMA_CC_UART1_SCRATCH 0x041C
2059 +/* PMU registers (rev >= 20) */
2060 +#define BCMA_CC_PMU_CTL 0x0600 /* PMU control */
2061 +#define BCMA_CC_PMU_CTL_ILP_DIV 0xFFFF0000 /* ILP div mask */
2062 +#define BCMA_CC_PMU_CTL_ILP_DIV_SHIFT 16
2063 +#define BCMA_CC_PMU_CTL_NOILPONW 0x00000200 /* No ILP on wait */
2064 +#define BCMA_CC_PMU_CTL_HTREQEN 0x00000100 /* HT req enable */
2065 +#define BCMA_CC_PMU_CTL_ALPREQEN 0x00000080 /* ALP req enable */
2066 +#define BCMA_CC_PMU_CTL_XTALFREQ 0x0000007C /* Crystal freq */
2067 +#define BCMA_CC_PMU_CTL_XTALFREQ_SHIFT 2
2068 +#define BCMA_CC_PMU_CTL_ILPDIVEN 0x00000002 /* ILP div enable */
2069 +#define BCMA_CC_PMU_CTL_LPOSEL 0x00000001 /* LPO sel */
2070 +#define BCMA_CC_PMU_CAP 0x0604 /* PMU capabilities */
2071 +#define BCMA_CC_PMU_CAP_REVISION 0x000000FF /* Revision mask */
2072 +#define BCMA_CC_PMU_STAT 0x0608 /* PMU status */
2073 +#define BCMA_CC_PMU_STAT_INTPEND 0x00000040 /* Interrupt pending */
2074 +#define BCMA_CC_PMU_STAT_SBCLKST 0x00000030 /* Backplane clock status? */
2075 +#define BCMA_CC_PMU_STAT_HAVEALP 0x00000008 /* ALP available */
2076 +#define BCMA_CC_PMU_STAT_HAVEHT 0x00000004 /* HT available */
2077 +#define BCMA_CC_PMU_STAT_RESINIT 0x00000003 /* Res init */
2078 +#define BCMA_CC_PMU_RES_STAT 0x060C /* PMU res status */
2079 +#define BCMA_CC_PMU_RES_PEND 0x0610 /* PMU res pending */
2080 +#define BCMA_CC_PMU_TIMER 0x0614 /* PMU timer */
2081 +#define BCMA_CC_PMU_MINRES_MSK 0x0618 /* PMU min res mask */
2082 +#define BCMA_CC_PMU_MAXRES_MSK 0x061C /* PMU max res mask */
2083 +#define BCMA_CC_PMU_RES_TABSEL 0x0620 /* PMU res table sel */
2084 +#define BCMA_CC_PMU_RES_DEPMSK 0x0624 /* PMU res dep mask */
2085 +#define BCMA_CC_PMU_RES_UPDNTM 0x0628 /* PMU res updown timer */
2086 +#define BCMA_CC_PMU_RES_TIMER 0x062C /* PMU res timer */
2087 +#define BCMA_CC_PMU_CLKSTRETCH 0x0630 /* PMU clockstretch */
2088 +#define BCMA_CC_PMU_WATCHDOG 0x0634 /* PMU watchdog */
2089 +#define BCMA_CC_PMU_RES_REQTS 0x0640 /* PMU res req timer sel */
2090 +#define BCMA_CC_PMU_RES_REQT 0x0644 /* PMU res req timer */
2091 +#define BCMA_CC_PMU_RES_REQM 0x0648 /* PMU res req mask */
2092 +#define BCMA_CC_CHIPCTL_ADDR 0x0650
2093 +#define BCMA_CC_CHIPCTL_DATA 0x0654
2094 +#define BCMA_CC_REGCTL_ADDR 0x0658
2095 +#define BCMA_CC_REGCTL_DATA 0x065C
2096 +#define BCMA_CC_PLLCTL_ADDR 0x0660
2097 +#define BCMA_CC_PLLCTL_DATA 0x0664
2098 +#define BCMA_CC_SPROM 0x0830 /* SPROM beginning */
2099 +
2100 +/* Data for the PMU, if available.
2101 + * Check availability with ((struct bcma_chipcommon)->capabilities & BCMA_CC_CAP_PMU)
2102 + */
2103 +struct bcma_chipcommon_pmu {
2104 + u8 rev; /* PMU revision */
2105 + u32 crystalfreq; /* The active crystal frequency (in kHz) */
2106 +};
2107 +
2108 +struct bcma_drv_cc {
2109 + struct bcma_device *core;
2110 + u32 status;
2111 + u32 capabilities;
2112 + u32 capabilities_ext;
2113 + /* Fast Powerup Delay constant */
2114 + u16 fast_pwrup_delay;
2115 + struct bcma_chipcommon_pmu pmu;
2116 +};
2117 +
2118 +/* Register access */
2119 +#define bcma_cc_read32(cc, offset) \
2120 + bcma_read32((cc)->core, offset)
2121 +#define bcma_cc_write32(cc, offset, val) \
2122 + bcma_write32((cc)->core, offset, val)
2123 +
2124 +#define bcma_cc_mask32(cc, offset, mask) \
2125 + bcma_cc_write32(cc, offset, bcma_cc_read32(cc, offset) & (mask))
2126 +#define bcma_cc_set32(cc, offset, set) \
2127 + bcma_cc_write32(cc, offset, bcma_cc_read32(cc, offset) | (set))
2128 +#define bcma_cc_maskset32(cc, offset, mask, set) \
2129 + bcma_cc_write32(cc, offset, (bcma_cc_read32(cc, offset) & (mask)) | (set))
2130 +
2131 +extern void bcma_core_chipcommon_init(struct bcma_drv_cc *cc);
2132 +
2133 +extern void bcma_chipco_suspend(struct bcma_drv_cc *cc);
2134 +extern void bcma_chipco_resume(struct bcma_drv_cc *cc);
2135 +
2136 +extern void bcma_chipco_watchdog_timer_set(struct bcma_drv_cc *cc,
2137 + u32 ticks);
2138 +
2139 +void bcma_chipco_irq_mask(struct bcma_drv_cc *cc, u32 mask, u32 value);
2140 +
2141 +u32 bcma_chipco_irq_status(struct bcma_drv_cc *cc, u32 mask);
2142 +
2143 +/* Chipcommon GPIO pin access. */
2144 +u32 bcma_chipco_gpio_in(struct bcma_drv_cc *cc, u32 mask);
2145 +u32 bcma_chipco_gpio_out(struct bcma_drv_cc *cc, u32 mask, u32 value);
2146 +u32 bcma_chipco_gpio_outen(struct bcma_drv_cc *cc, u32 mask, u32 value);
2147 +u32 bcma_chipco_gpio_control(struct bcma_drv_cc *cc, u32 mask, u32 value);
2148 +u32 bcma_chipco_gpio_intmask(struct bcma_drv_cc *cc, u32 mask, u32 value);
2149 +u32 bcma_chipco_gpio_polarity(struct bcma_drv_cc *cc, u32 mask, u32 value);
2150 +
2151 +/* PMU support */
2152 +extern void bcma_pmu_init(struct bcma_drv_cc *cc);
2153 +
2154 +#endif /* LINUX_BCMA_DRIVER_CC_H_ */
2155 --- /dev/null
2156 +++ b/include/linux/bcma/bcma_driver_pci.h
2157 @@ -0,0 +1,91 @@
2158 +#ifndef LINUX_BCMA_DRIVER_PCI_H_
2159 +#define LINUX_BCMA_DRIVER_PCI_H_
2160 +
2161 +#include <linux/types.h>
2162 +
2163 +struct pci_dev;
2164 +
2165 +/** PCI core registers. **/
2166 +#define BCMA_CORE_PCI_CTL 0x0000 /* PCI Control */
2167 +#define BCMA_CORE_PCI_CTL_RST_OE 0x00000001 /* PCI_RESET Output Enable */
2168 +#define BCMA_CORE_PCI_CTL_RST 0x00000002 /* PCI_RESET driven out to pin */
2169 +#define BCMA_CORE_PCI_CTL_CLK_OE 0x00000004 /* Clock gate Output Enable */
2170 +#define BCMA_CORE_PCI_CTL_CLK 0x00000008 /* Gate for clock driven out to pin */
2171 +#define BCMA_CORE_PCI_ARBCTL 0x0010 /* PCI Arbiter Control */
2172 +#define BCMA_CORE_PCI_ARBCTL_INTERN 0x00000001 /* Use internal arbiter */
2173 +#define BCMA_CORE_PCI_ARBCTL_EXTERN 0x00000002 /* Use external arbiter */
2174 +#define BCMA_CORE_PCI_ARBCTL_PARKID 0x00000006 /* Mask, selects which agent is parked on an idle bus */
2175 +#define BCMA_CORE_PCI_ARBCTL_PARKID_LAST 0x00000000 /* Last requestor */
2176 +#define BCMA_CORE_PCI_ARBCTL_PARKID_4710 0x00000002 /* 4710 */
2177 +#define BCMA_CORE_PCI_ARBCTL_PARKID_EXT0 0x00000004 /* External requestor 0 */
2178 +#define BCMA_CORE_PCI_ARBCTL_PARKID_EXT1 0x00000006 /* External requestor 1 */
2179 +#define BCMA_CORE_PCI_ISTAT 0x0020 /* Interrupt status */
2180 +#define BCMA_CORE_PCI_ISTAT_INTA 0x00000001 /* PCI INTA# */
2181 +#define BCMA_CORE_PCI_ISTAT_INTB 0x00000002 /* PCI INTB# */
2182 +#define BCMA_CORE_PCI_ISTAT_SERR 0x00000004 /* PCI SERR# (write to clear) */
2183 +#define BCMA_CORE_PCI_ISTAT_PERR 0x00000008 /* PCI PERR# (write to clear) */
2184 +#define BCMA_CORE_PCI_ISTAT_PME 0x00000010 /* PCI PME# */
2185 +#define BCMA_CORE_PCI_IMASK 0x0024 /* Interrupt mask */
2186 +#define BCMA_CORE_PCI_IMASK_INTA 0x00000001 /* PCI INTA# */
2187 +#define BCMA_CORE_PCI_IMASK_INTB 0x00000002 /* PCI INTB# */
2188 +#define BCMA_CORE_PCI_IMASK_SERR 0x00000004 /* PCI SERR# */
2189 +#define BCMA_CORE_PCI_IMASK_PERR 0x00000008 /* PCI PERR# */
2190 +#define BCMA_CORE_PCI_IMASK_PME 0x00000010 /* PCI PME# */
2191 +#define BCMA_CORE_PCI_MBOX 0x0028 /* Backplane to PCI Mailbox */
2192 +#define BCMA_CORE_PCI_MBOX_F0_0 0x00000100 /* PCI function 0, INT 0 */
2193 +#define BCMA_CORE_PCI_MBOX_F0_1 0x00000200 /* PCI function 0, INT 1 */
2194 +#define BCMA_CORE_PCI_MBOX_F1_0 0x00000400 /* PCI function 1, INT 0 */
2195 +#define BCMA_CORE_PCI_MBOX_F1_1 0x00000800 /* PCI function 1, INT 1 */
2196 +#define BCMA_CORE_PCI_MBOX_F2_0 0x00001000 /* PCI function 2, INT 0 */
2197 +#define BCMA_CORE_PCI_MBOX_F2_1 0x00002000 /* PCI function 2, INT 1 */
2198 +#define BCMA_CORE_PCI_MBOX_F3_0 0x00004000 /* PCI function 3, INT 0 */
2199 +#define BCMA_CORE_PCI_MBOX_F3_1 0x00008000 /* PCI function 3, INT 1 */
2200 +#define BCMA_CORE_PCI_BCAST_ADDR 0x0050 /* Backplane Broadcast Address */
2201 +#define BCMA_CORE_PCI_BCAST_ADDR_MASK 0x000000FF
2202 +#define BCMA_CORE_PCI_BCAST_DATA 0x0054 /* Backplane Broadcast Data */
2203 +#define BCMA_CORE_PCI_GPIO_IN 0x0060 /* rev >= 2 only */
2204 +#define BCMA_CORE_PCI_GPIO_OUT 0x0064 /* rev >= 2 only */
2205 +#define BCMA_CORE_PCI_GPIO_ENABLE 0x0068 /* rev >= 2 only */
2206 +#define BCMA_CORE_PCI_GPIO_CTL 0x006C /* rev >= 2 only */
2207 +#define BCMA_CORE_PCI_SBTOPCI0 0x0100 /* Backplane to PCI translation 0 (sbtopci0) */
2208 +#define BCMA_CORE_PCI_SBTOPCI0_MASK 0xFC000000
2209 +#define BCMA_CORE_PCI_SBTOPCI1 0x0104 /* Backplane to PCI translation 1 (sbtopci1) */
2210 +#define BCMA_CORE_PCI_SBTOPCI1_MASK 0xFC000000
2211 +#define BCMA_CORE_PCI_SBTOPCI2 0x0108 /* Backplane to PCI translation 2 (sbtopci2) */
2212 +#define BCMA_CORE_PCI_SBTOPCI2_MASK 0xC0000000
2213 +#define BCMA_CORE_PCI_PCICFG0 0x0400 /* PCI config space 0 (rev >= 8) */
2214 +#define BCMA_CORE_PCI_PCICFG1 0x0500 /* PCI config space 1 (rev >= 8) */
2215 +#define BCMA_CORE_PCI_PCICFG2 0x0600 /* PCI config space 2 (rev >= 8) */
2216 +#define BCMA_CORE_PCI_PCICFG3 0x0700 /* PCI config space 3 (rev >= 8) */
2217 +#define BCMA_CORE_PCI_SPROM(wordoffset) (0x0800 + ((wordoffset) * 2)) /* SPROM shadow area (72 bytes) */
2218 +
2219 +/* SBtoPCIx */
2220 +#define BCMA_CORE_PCI_SBTOPCI_MEM 0x00000000
2221 +#define BCMA_CORE_PCI_SBTOPCI_IO 0x00000001
2222 +#define BCMA_CORE_PCI_SBTOPCI_CFG0 0x00000002
2223 +#define BCMA_CORE_PCI_SBTOPCI_CFG1 0x00000003
2224 +#define BCMA_CORE_PCI_SBTOPCI_PREF 0x00000004 /* Prefetch enable */
2225 +#define BCMA_CORE_PCI_SBTOPCI_BURST 0x00000008 /* Burst enable */
2226 +#define BCMA_CORE_PCI_SBTOPCI_MRM 0x00000020 /* Memory Read Multiple */
2227 +#define BCMA_CORE_PCI_SBTOPCI_RC 0x00000030 /* Read Command mask (rev >= 11) */
2228 +#define BCMA_CORE_PCI_SBTOPCI_RC_READ 0x00000000 /* Memory read */
2229 +#define BCMA_CORE_PCI_SBTOPCI_RC_READL 0x00000010 /* Memory read line */
2230 +#define BCMA_CORE_PCI_SBTOPCI_RC_READM 0x00000020 /* Memory read multiple */
2231 +
2232 +/* PCIcore specific boardflags */
2233 +#define BCMA_CORE_PCI_BFL_NOPCI 0x00000400 /* Board leaves PCI floating */
2234 +
2235 +struct bcma_drv_pci {
2236 + struct bcma_device *core;
2237 + u8 setup_done:1;
2238 +};
2239 +
2240 +/* Register access */
2241 +#define pcicore_read32(pc, offset) bcma_read32((pc)->core, offset)
2242 +#define pcicore_write32(pc, offset, val) bcma_write32((pc)->core, offset, val)
2243 +
2244 +extern void bcma_core_pci_init(struct bcma_drv_pci *pc);
2245 +extern int bcma_core_pci_irq_ctl(struct bcma_drv_pci *pc,
2246 + struct bcma_device *core, bool enable);
2247 +
2248 +#endif /* LINUX_BCMA_DRIVER_PCI_H_ */
2249 --- /dev/null
2250 +++ b/include/linux/bcma/bcma_regs.h
2251 @@ -0,0 +1,34 @@
2252 +#ifndef LINUX_BCMA_REGS_H_
2253 +#define LINUX_BCMA_REGS_H_
2254 +
2255 +/* Agent registers (common for every core) */
2256 +#define BCMA_IOCTL 0x0408
2257 +#define BCMA_IOCTL_CLK 0x0001
2258 +#define BCMA_IOCTL_FGC 0x0002
2259 +#define BCMA_IOCTL_CORE_BITS 0x3FFC
2260 +#define BCMA_IOCTL_PME_EN 0x4000
2261 +#define BCMA_IOCTL_BIST_EN 0x8000
2262 +#define BCMA_RESET_CTL 0x0800
2263 +#define BCMA_RESET_CTL_RESET 0x0001
2264 +
2265 +/* BCMA PCI config space registers. */
2266 +#define BCMA_PCI_PMCSR 0x44
2267 +#define BCMA_PCI_PE 0x100
2268 +#define BCMA_PCI_BAR0_WIN 0x80 /* Backplane address space 0 */
2269 +#define BCMA_PCI_BAR1_WIN 0x84 /* Backplane address space 1 */
2270 +#define BCMA_PCI_SPROMCTL 0x88 /* SPROM control */
2271 +#define BCMA_PCI_SPROMCTL_WE 0x10 /* SPROM write enable */
2272 +#define BCMA_PCI_BAR1_CONTROL 0x8c /* Address space 1 burst control */
2273 +#define BCMA_PCI_IRQS 0x90 /* PCI interrupts */
2274 +#define BCMA_PCI_IRQMASK 0x94 /* PCI IRQ control and mask (pcirev >= 6 only) */
2275 +#define BCMA_PCI_BACKPLANE_IRQS 0x98 /* Backplane Interrupts */
2276 +#define BCMA_PCI_BAR0_WIN2 0xAC
2277 +#define BCMA_PCI_GPIO_IN 0xB0 /* GPIO Input (pcirev >= 3 only) */
2278 +#define BCMA_PCI_GPIO_OUT 0xB4 /* GPIO Output (pcirev >= 3 only) */
2279 +#define BCMA_PCI_GPIO_OUT_ENABLE 0xB8 /* GPIO Output Enable/Disable (pcirev >= 3 only) */
2280 +#define BCMA_PCI_GPIO_SCS 0x10 /* PCI config space bit 4 for 4306c0 slow clock source */
2281 +#define BCMA_PCI_GPIO_HWRAD 0x20 /* PCI config space GPIO 13 for hw radio disable */
2282 +#define BCMA_PCI_GPIO_XTAL 0x40 /* PCI config space GPIO 14 for Xtal powerup */
2283 +#define BCMA_PCI_GPIO_PLL 0x80 /* PCI config space GPIO 15 for PLL powerdown */
2284 +
2285 +#endif /* LINUX_BCMA_REGS_H_ */
2286 --- a/include/linux/mod_devicetable.h
2287 +++ b/include/linux/mod_devicetable.h
2288 @@ -382,6 +382,23 @@ struct ssb_device_id {
2289 #define SSB_ANY_ID 0xFFFF
2290 #define SSB_ANY_REV 0xFF
2291
2292 +/* Broadcom's specific AMBA core, see drivers/bcma/ */
2293 +struct bcma_device_id {
2294 + __u16 manuf;
2295 + __u16 id;
2296 + __u8 rev;
2297 + __u8 class;
2298 +};
2299 +#define BCMA_CORE(_manuf, _id, _rev, _class) \
2300 + { .manuf = _manuf, .id = _id, .rev = _rev, .class = _class, }
2301 +#define BCMA_CORETABLE_END \
2302 + { 0, },
2303 +
2304 +#define BCMA_ANY_MANUF 0xFFFF
2305 +#define BCMA_ANY_ID 0xFFFF
2306 +#define BCMA_ANY_REV 0xFF
2307 +#define BCMA_ANY_CLASS 0xFF
2308 +
2309 struct virtio_device_id {
2310 __u32 device;
2311 __u32 vendor;
2312 --- a/scripts/mod/file2alias.c
2313 +++ b/scripts/mod/file2alias.c
2314 @@ -702,6 +702,24 @@ static int do_ssb_entry(const char *file
2315 return 1;
2316 }
2317
2318 +/* Looks like: bcma:mNidNrevNclN. */
2319 +static int do_bcma_entry(const char *filename,
2320 + struct bcma_device_id *id, char *alias)
2321 +{
2322 + id->manuf = TO_NATIVE(id->manuf);
2323 + id->id = TO_NATIVE(id->id);
2324 + id->rev = TO_NATIVE(id->rev);
2325 + id->class = TO_NATIVE(id->class);
2326 +
2327 + strcpy(alias, "bcma:");
2328 + ADD(alias, "m", id->manuf != BCMA_ANY_MANUF, id->manuf);
2329 + ADD(alias, "id", id->id != BCMA_ANY_ID, id->id);
2330 + ADD(alias, "rev", id->rev != BCMA_ANY_REV, id->rev);
2331 + ADD(alias, "cl", id->class != BCMA_ANY_CLASS, id->class);
2332 + add_wildcard(alias);
2333 + return 1;
2334 +}
2335 +
2336 /* Looks like: virtio:dNvN */
2337 static int do_virtio_entry(const char *filename, struct virtio_device_id *id,
2338 char *alias)
2339 @@ -968,6 +986,10 @@ void handle_moddevtable(struct module *m
2340 do_table(symval, sym->st_size,
2341 sizeof(struct ssb_device_id), "ssb",
2342 do_ssb_entry, mod);
2343 + else if (sym_is(symname, "__mod_bcma_device_table"))
2344 + do_table(symval, sym->st_size,
2345 + sizeof(struct bcma_device_id), "bcma",
2346 + do_bcma_entry, mod);
2347 else if (sym_is(symname, "__mod_virtio_device_table"))
2348 do_table(symval, sym->st_size,
2349 sizeof(struct virtio_device_id), "virtio",
2350 --- /dev/null
2351 +++ b/drivers/bcma/sprom.c
2352 @@ -0,0 +1,162 @@
2353 +/*
2354 + * Broadcom specific AMBA
2355 + * SPROM reading
2356 + *
2357 + * Licensed under the GNU/GPL. See COPYING for details.
2358 + */
2359 +
2360 +#include "bcma_private.h"
2361 +
2362 +#include <linux/bcma/bcma.h>
2363 +#include <linux/bcma/bcma_regs.h>
2364 +#include <linux/pci.h>
2365 +#include <linux/io.h>
2366 +#include <linux/dma-mapping.h>
2367 +#include <linux/slab.h>
2368 +
2369 +#define SPOFF(offset) ((offset) / sizeof(u16))
2370 +
2371 +/**************************************************
2372 + * R/W ops.
2373 + **************************************************/
2374 +
2375 +static void bcma_sprom_read(struct bcma_bus *bus, u16 *sprom)
2376 +{
2377 + int i;
2378 + for (i = 0; i < SSB_SPROMSIZE_WORDS_R4; i++)
2379 + sprom[i] = bcma_read16(bus->drv_cc.core,
2380 + BCMA_CC_SPROM + (i * 2));
2381 +}
2382 +
2383 +/**************************************************
2384 + * Validation.
2385 + **************************************************/
2386 +
2387 +static inline u8 bcma_crc8(u8 crc, u8 data)
2388 +{
2389 + /* Polynomial: x^8 + x^7 + x^6 + x^4 + x^2 + 1 */
2390 + static const u8 t[] = {
2391 + 0x00, 0xF7, 0xB9, 0x4E, 0x25, 0xD2, 0x9C, 0x6B,
2392 + 0x4A, 0xBD, 0xF3, 0x04, 0x6F, 0x98, 0xD6, 0x21,
2393 + 0x94, 0x63, 0x2D, 0xDA, 0xB1, 0x46, 0x08, 0xFF,
2394 + 0xDE, 0x29, 0x67, 0x90, 0xFB, 0x0C, 0x42, 0xB5,
2395 + 0x7F, 0x88, 0xC6, 0x31, 0x5A, 0xAD, 0xE3, 0x14,
2396 + 0x35, 0xC2, 0x8C, 0x7B, 0x10, 0xE7, 0xA9, 0x5E,
2397 + 0xEB, 0x1C, 0x52, 0xA5, 0xCE, 0x39, 0x77, 0x80,
2398 + 0xA1, 0x56, 0x18, 0xEF, 0x84, 0x73, 0x3D, 0xCA,
2399 + 0xFE, 0x09, 0x47, 0xB0, 0xDB, 0x2C, 0x62, 0x95,
2400 + 0xB4, 0x43, 0x0D, 0xFA, 0x91, 0x66, 0x28, 0xDF,
2401 + 0x6A, 0x9D, 0xD3, 0x24, 0x4F, 0xB8, 0xF6, 0x01,
2402 + 0x20, 0xD7, 0x99, 0x6E, 0x05, 0xF2, 0xBC, 0x4B,
2403 + 0x81, 0x76, 0x38, 0xCF, 0xA4, 0x53, 0x1D, 0xEA,
2404 + 0xCB, 0x3C, 0x72, 0x85, 0xEE, 0x19, 0x57, 0xA0,
2405 + 0x15, 0xE2, 0xAC, 0x5B, 0x30, 0xC7, 0x89, 0x7E,
2406 + 0x5F, 0xA8, 0xE6, 0x11, 0x7A, 0x8D, 0xC3, 0x34,
2407 + 0xAB, 0x5C, 0x12, 0xE5, 0x8E, 0x79, 0x37, 0xC0,
2408 + 0xE1, 0x16, 0x58, 0xAF, 0xC4, 0x33, 0x7D, 0x8A,
2409 + 0x3F, 0xC8, 0x86, 0x71, 0x1A, 0xED, 0xA3, 0x54,
2410 + 0x75, 0x82, 0xCC, 0x3B, 0x50, 0xA7, 0xE9, 0x1E,
2411 + 0xD4, 0x23, 0x6D, 0x9A, 0xF1, 0x06, 0x48, 0xBF,
2412 + 0x9E, 0x69, 0x27, 0xD0, 0xBB, 0x4C, 0x02, 0xF5,
2413 + 0x40, 0xB7, 0xF9, 0x0E, 0x65, 0x92, 0xDC, 0x2B,
2414 + 0x0A, 0xFD, 0xB3, 0x44, 0x2F, 0xD8, 0x96, 0x61,
2415 + 0x55, 0xA2, 0xEC, 0x1B, 0x70, 0x87, 0xC9, 0x3E,
2416 + 0x1F, 0xE8, 0xA6, 0x51, 0x3A, 0xCD, 0x83, 0x74,
2417 + 0xC1, 0x36, 0x78, 0x8F, 0xE4, 0x13, 0x5D, 0xAA,
2418 + 0x8B, 0x7C, 0x32, 0xC5, 0xAE, 0x59, 0x17, 0xE0,
2419 + 0x2A, 0xDD, 0x93, 0x64, 0x0F, 0xF8, 0xB6, 0x41,
2420 + 0x60, 0x97, 0xD9, 0x2E, 0x45, 0xB2, 0xFC, 0x0B,
2421 + 0xBE, 0x49, 0x07, 0xF0, 0x9B, 0x6C, 0x22, 0xD5,
2422 + 0xF4, 0x03, 0x4D, 0xBA, 0xD1, 0x26, 0x68, 0x9F,
2423 + };
2424 + return t[crc ^ data];
2425 +}
2426 +
2427 +static u8 bcma_sprom_crc(const u16 *sprom)
2428 +{
2429 + int word;
2430 + u8 crc = 0xFF;
2431 +
2432 + for (word = 0; word < SSB_SPROMSIZE_WORDS_R4 - 1; word++) {
2433 + crc = bcma_crc8(crc, sprom[word] & 0x00FF);
2434 + crc = bcma_crc8(crc, (sprom[word] & 0xFF00) >> 8);
2435 + }
2436 + crc = bcma_crc8(crc, sprom[SSB_SPROMSIZE_WORDS_R4 - 1] & 0x00FF);
2437 + crc ^= 0xFF;
2438 +
2439 + return crc;
2440 +}
2441 +
2442 +static int bcma_sprom_check_crc(const u16 *sprom)
2443 +{
2444 + u8 crc;
2445 + u8 expected_crc;
2446 + u16 tmp;
2447 +
2448 + crc = bcma_sprom_crc(sprom);
2449 + tmp = sprom[SSB_SPROMSIZE_WORDS_R4 - 1] & SSB_SPROM_REVISION_CRC;
2450 + expected_crc = tmp >> SSB_SPROM_REVISION_CRC_SHIFT;
2451 + if (crc != expected_crc)
2452 + return -EPROTO;
2453 +
2454 + return 0;
2455 +}
2456 +
2457 +static int bcma_sprom_valid(const u16 *sprom)
2458 +{
2459 + u16 revision;
2460 + int err;
2461 +
2462 + err = bcma_sprom_check_crc(sprom);
2463 + if (err)
2464 + return err;
2465 +
2466 + revision = sprom[SSB_SPROMSIZE_WORDS_R4 - 1] & SSB_SPROM_REVISION_REV;
2467 + if (revision != 8) {
2468 + pr_err("Unsupported SPROM revision: %d\n", revision);
2469 + return -ENOENT;
2470 + }
2471 +
2472 + return 0;
2473 +}
2474 +
2475 +/**************************************************
2476 + * SPROM extraction.
2477 + **************************************************/
2478 +
2479 +static void bcma_sprom_extract_r8(struct bcma_bus *bus, const u16 *sprom)
2480 +{
2481 + u16 v;
2482 + int i;
2483 +
2484 + for (i = 0; i < 3; i++) {
2485 + v = sprom[SPOFF(SSB_SPROM8_IL0MAC) + i];
2486 + *(((__be16 *)bus->sprom.il0mac) + i) = cpu_to_be16(v);
2487 + }
2488 +}
2489 +
2490 +int bcma_sprom_get(struct bcma_bus *bus)
2491 +{
2492 + u16 *sprom;
2493 + int err = 0;
2494 +
2495 + if (!bus->drv_cc.core)
2496 + return -EOPNOTSUPP;
2497 +
2498 + sprom = kcalloc(SSB_SPROMSIZE_WORDS_R4, sizeof(u16),
2499 + GFP_KERNEL);
2500 + if (!sprom)
2501 + return -ENOMEM;
2502 +
2503 + bcma_sprom_read(bus, sprom);
2504 +
2505 + err = bcma_sprom_valid(sprom);
2506 + if (err)
2507 + goto out;
2508 +
2509 + bcma_sprom_extract_r8(bus, sprom);
2510 +
2511 +out:
2512 + kfree(sprom);
2513 + return err;
2514 +}
Personal OpenWRT clone
This page took 0.149703 seconds and 5 git commands to generate.