1 --- a/arch/mips/bcm47xx/nvram.c
2 +++ b/arch/mips/bcm47xx/nvram.c
3 @@ -43,8 +43,8 @@ static void early_nvram_init(void)
4 #ifdef CONFIG_BCM47XX_SSB
5 case BCM47XX_BUS_TYPE_SSB:
6 mcore_ssb = &bcm47xx_bus.ssb.mipscore;
7 - base = mcore_ssb->flash_window;
8 - lim = mcore_ssb->flash_window_size;
9 + base = mcore_ssb->pflash.window;
10 + lim = mcore_ssb->pflash.window_size;
13 #ifdef CONFIG_BCM47XX_BCMA
14 --- a/arch/mips/bcm47xx/wgt634u.c
15 +++ b/arch/mips/bcm47xx/wgt634u.c
16 @@ -156,10 +156,10 @@ static int __init wgt634u_init(void)
20 - wgt634u_flash_data.width = mcore->flash_buswidth;
21 - wgt634u_flash_resource.start = mcore->flash_window;
22 - wgt634u_flash_resource.end = mcore->flash_window
23 - + mcore->flash_window_size
24 + wgt634u_flash_data.width = mcore->pflash.buswidth;
25 + wgt634u_flash_resource.start = mcore->pflash.window;
26 + wgt634u_flash_resource.end = mcore->pflash.window
27 + + mcore->pflash.window_size
29 return platform_add_devices(wgt634u_devices,
30 ARRAY_SIZE(wgt634u_devices));
31 --- a/drivers/ssb/Kconfig
32 +++ b/drivers/ssb/Kconfig
33 @@ -136,6 +136,11 @@ config SSB_DRIVER_MIPS
38 + bool "SSB serial flash support"
39 + depends on SSB_DRIVER_MIPS && BROKEN
42 # Assumption: We are on embedded, if we compile the MIPS core.
45 @@ -160,4 +165,12 @@ config SSB_DRIVER_GIGE
49 +config SSB_DRIVER_GPIO
50 + bool "SSB GPIO driver"
51 + depends on SSB && GPIOLIB
53 + Driver to provide access to the GPIO pins on the bus.
58 --- a/drivers/ssb/Makefile
59 +++ b/drivers/ssb/Makefile
60 @@ -11,10 +11,12 @@ ssb-$(CONFIG_SSB_SDIOHOST) += sdio.o
62 ssb-y += driver_chipcommon.o
63 ssb-y += driver_chipcommon_pmu.o
64 +ssb-$(CONFIG_SSB_SFLASH) += driver_chipcommon_sflash.o
65 ssb-$(CONFIG_SSB_DRIVER_MIPS) += driver_mipscore.o
66 ssb-$(CONFIG_SSB_DRIVER_EXTIF) += driver_extif.o
67 ssb-$(CONFIG_SSB_DRIVER_PCICORE) += driver_pcicore.o
68 ssb-$(CONFIG_SSB_DRIVER_GIGE) += driver_gige.o
69 +ssb-$(CONFIG_SSB_DRIVER_GPIO) += driver_gpio.o
71 # b43 pci-ssb-bridge driver
72 # Not strictly a part of SSB, but kept here for convenience
73 --- a/drivers/ssb/b43_pci_bridge.c
74 +++ b/drivers/ssb/b43_pci_bridge.c
75 @@ -37,6 +37,7 @@ static const struct pci_device_id b43_pc
76 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4329) },
77 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x432b) },
78 { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x432c) },
79 + { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4350) },
82 MODULE_DEVICE_TABLE(pci, b43_pci_bridge_tbl);
83 --- a/drivers/ssb/driver_chipcommon.c
84 +++ b/drivers/ssb/driver_chipcommon.c
87 * Copyright 2005, Broadcom Corporation
88 * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
89 + * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
91 * Licensed under the GNU/GPL. See COPYING for details.
94 #include <linux/ssb/ssb_regs.h>
95 #include <linux/export.h>
96 #include <linux/pci.h>
97 +#include <linux/bcm47xx_wdt.h>
99 #include "ssb_private.h"
101 @@ -280,10 +282,76 @@ static void calc_fast_powerup_delay(stru
102 cc->fast_pwrup_delay = tmp;
105 +static u32 ssb_chipco_alp_clock(struct ssb_chipcommon *cc)
107 + if (cc->capabilities & SSB_CHIPCO_CAP_PMU)
108 + return ssb_pmu_get_alp_clock(cc);
113 +static u32 ssb_chipco_watchdog_get_max_timer(struct ssb_chipcommon *cc)
117 + if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
118 + if (cc->dev->id.revision < 26)
121 + nb = (cc->dev->id.revision >= 37) ? 32 : 24;
128 + return (1 << nb) - 1;
131 +u32 ssb_chipco_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt, u32 ticks)
133 + struct ssb_chipcommon *cc = bcm47xx_wdt_get_drvdata(wdt);
135 + if (cc->dev->bus->bustype != SSB_BUSTYPE_SSB)
138 + return ssb_chipco_watchdog_timer_set(cc, ticks);
141 +u32 ssb_chipco_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt, u32 ms)
143 + struct ssb_chipcommon *cc = bcm47xx_wdt_get_drvdata(wdt);
146 + if (cc->dev->bus->bustype != SSB_BUSTYPE_SSB)
149 + ticks = ssb_chipco_watchdog_timer_set(cc, cc->ticks_per_ms * ms);
150 + return ticks / cc->ticks_per_ms;
153 +static int ssb_chipco_watchdog_ticks_per_ms(struct ssb_chipcommon *cc)
155 + struct ssb_bus *bus = cc->dev->bus;
157 + if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
158 + /* based on 32KHz ILP clock */
161 + if (cc->dev->id.revision < 18)
162 + return ssb_clockspeed(bus) / 1000;
164 + return ssb_chipco_alp_clock(cc) / 1000;
168 void ssb_chipcommon_init(struct ssb_chipcommon *cc)
171 return; /* We don't have a ChipCommon */
173 + spin_lock_init(&cc->gpio_lock);
175 if (cc->dev->id.revision >= 11)
176 cc->status = chipco_read32(cc, SSB_CHIPCO_CHIPSTAT);
177 ssb_dprintk(KERN_INFO PFX "chipcommon status is 0x%x\n", cc->status);
178 @@ -297,6 +365,11 @@ void ssb_chipcommon_init(struct ssb_chip
179 chipco_powercontrol_init(cc);
180 ssb_chipco_set_clockmode(cc, SSB_CLKMODE_FAST);
181 calc_fast_powerup_delay(cc);
183 + if (cc->dev->bus->bustype == SSB_BUSTYPE_SSB) {
184 + cc->ticks_per_ms = ssb_chipco_watchdog_ticks_per_ms(cc);
185 + cc->max_timer_ms = ssb_chipco_watchdog_get_max_timer(cc) / cc->ticks_per_ms;
189 void ssb_chipco_suspend(struct ssb_chipcommon *cc)
190 @@ -395,10 +468,27 @@ void ssb_chipco_timing_init(struct ssb_c
193 /* Set chip watchdog reset timer to fire in 'ticks' backplane cycles */
194 -void ssb_chipco_watchdog_timer_set(struct ssb_chipcommon *cc, u32 ticks)
195 +u32 ssb_chipco_watchdog_timer_set(struct ssb_chipcommon *cc, u32 ticks)
198 - chipco_write32(cc, SSB_CHIPCO_WATCHDOG, ticks);
200 + enum ssb_clkmode clkmode;
202 + maxt = ssb_chipco_watchdog_get_max_timer(cc);
203 + if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
206 + else if (ticks > maxt)
208 + chipco_write32(cc, SSB_CHIPCO_PMU_WATCHDOG, ticks);
210 + clkmode = ticks ? SSB_CLKMODE_FAST : SSB_CLKMODE_DYNAMIC;
211 + ssb_chipco_set_clockmode(cc, clkmode);
215 + chipco_write32(cc, SSB_CHIPCO_WATCHDOG, ticks);
220 void ssb_chipco_irq_mask(struct ssb_chipcommon *cc, u32 mask, u32 value)
221 @@ -418,28 +508,93 @@ u32 ssb_chipco_gpio_in(struct ssb_chipco
223 u32 ssb_chipco_gpio_out(struct ssb_chipcommon *cc, u32 mask, u32 value)
225 - return chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUT, mask, value);
226 + unsigned long flags;
229 + spin_lock_irqsave(&cc->gpio_lock, flags);
230 + res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUT, mask, value);
231 + spin_unlock_irqrestore(&cc->gpio_lock, flags);
236 u32 ssb_chipco_gpio_outen(struct ssb_chipcommon *cc, u32 mask, u32 value)
238 - return chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUTEN, mask, value);
239 + unsigned long flags;
242 + spin_lock_irqsave(&cc->gpio_lock, flags);
243 + res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOOUTEN, mask, value);
244 + spin_unlock_irqrestore(&cc->gpio_lock, flags);
249 u32 ssb_chipco_gpio_control(struct ssb_chipcommon *cc, u32 mask, u32 value)
251 - return chipco_write32_masked(cc, SSB_CHIPCO_GPIOCTL, mask, value);
252 + unsigned long flags;
255 + spin_lock_irqsave(&cc->gpio_lock, flags);
256 + res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOCTL, mask, value);
257 + spin_unlock_irqrestore(&cc->gpio_lock, flags);
261 EXPORT_SYMBOL(ssb_chipco_gpio_control);
263 u32 ssb_chipco_gpio_intmask(struct ssb_chipcommon *cc, u32 mask, u32 value)
265 - return chipco_write32_masked(cc, SSB_CHIPCO_GPIOIRQ, mask, value);
266 + unsigned long flags;
269 + spin_lock_irqsave(&cc->gpio_lock, flags);
270 + res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOIRQ, mask, value);
271 + spin_unlock_irqrestore(&cc->gpio_lock, flags);
276 u32 ssb_chipco_gpio_polarity(struct ssb_chipcommon *cc, u32 mask, u32 value)
278 - return chipco_write32_masked(cc, SSB_CHIPCO_GPIOPOL, mask, value);
279 + unsigned long flags;
282 + spin_lock_irqsave(&cc->gpio_lock, flags);
283 + res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPOL, mask, value);
284 + spin_unlock_irqrestore(&cc->gpio_lock, flags);
289 +u32 ssb_chipco_gpio_pullup(struct ssb_chipcommon *cc, u32 mask, u32 value)
291 + unsigned long flags;
294 + if (cc->dev->id.revision < 20)
297 + spin_lock_irqsave(&cc->gpio_lock, flags);
298 + res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPULLUP, mask, value);
299 + spin_unlock_irqrestore(&cc->gpio_lock, flags);
304 +u32 ssb_chipco_gpio_pulldown(struct ssb_chipcommon *cc, u32 mask, u32 value)
306 + unsigned long flags;
309 + if (cc->dev->id.revision < 20)
312 + spin_lock_irqsave(&cc->gpio_lock, flags);
313 + res = chipco_write32_masked(cc, SSB_CHIPCO_GPIOPULLDOWN, mask, value);
314 + spin_unlock_irqrestore(&cc->gpio_lock, flags);
319 #ifdef CONFIG_SSB_SERIAL
320 @@ -473,12 +628,7 @@ int ssb_chipco_serial_init(struct ssb_ch
321 chipco_read32(cc, SSB_CHIPCO_CORECTL)
322 | SSB_CHIPCO_CORECTL_UARTCLK0);
323 } else if ((ccrev >= 11) && (ccrev != 15)) {
324 - /* Fixed ALP clock */
325 - baud_base = 20000000;
326 - if (cc->capabilities & SSB_CHIPCO_CAP_PMU) {
327 - /* FIXME: baud_base is different for devices with a PMU */
330 + baud_base = ssb_chipco_alp_clock(cc);
333 /* Turn off UART clock before switching clocksource. */
334 --- a/drivers/ssb/driver_chipcommon_pmu.c
335 +++ b/drivers/ssb/driver_chipcommon_pmu.c
336 @@ -346,6 +346,8 @@ static void ssb_pmu_pll_init(struct ssb_
337 chipco_write32(cc, SSB_CHIPCO_PLLCTL_DATA, 0x380005C0);
343 ssb_printk(KERN_ERR PFX
344 "ERROR: PLL init unknown for device %04X\n",
345 @@ -434,6 +436,7 @@ static void ssb_pmu_resources_init(struc
350 /* We keep the default settings:
353 @@ -615,6 +618,33 @@ void ssb_pmu_set_ldo_paref(struct ssb_ch
354 EXPORT_SYMBOL(ssb_pmu_set_ldo_voltage);
355 EXPORT_SYMBOL(ssb_pmu_set_ldo_paref);
357 +static u32 ssb_pmu_get_alp_clock_clk0(struct ssb_chipcommon *cc)
360 + const struct pmu0_plltab_entry *e = NULL;
362 + crystalfreq = chipco_read32(cc, SSB_CHIPCO_PMU_CTL) &
363 + SSB_CHIPCO_PMU_CTL_XTALFREQ >> SSB_CHIPCO_PMU_CTL_XTALFREQ_SHIFT;
364 + e = pmu0_plltab_find_entry(crystalfreq);
366 + return e->freq * 1000;
369 +u32 ssb_pmu_get_alp_clock(struct ssb_chipcommon *cc)
371 + struct ssb_bus *bus = cc->dev->bus;
373 + switch (bus->chip_id) {
375 + ssb_pmu_get_alp_clock_clk0(cc);
377 + ssb_printk(KERN_ERR PFX
378 + "ERROR: PMU alp clock unknown for device %04X\n",
384 u32 ssb_pmu_get_cpu_clock(struct ssb_chipcommon *cc)
386 struct ssb_bus *bus = cc->dev->bus;
387 @@ -645,3 +675,32 @@ u32 ssb_pmu_get_controlclock(struct ssb_
392 +void ssb_pmu_spuravoid_pllupdate(struct ssb_chipcommon *cc, int spuravoid)
396 + switch (cc->dev->bus->chip_id) {
398 + ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL0, 0x11100070);
399 + ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL1, 0x1014140a);
400 + ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL5, 0x88888854);
401 + if (spuravoid == 1)
402 + ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL2, 0x05201828);
404 + ssb_chipco_pll_write(cc, SSB_PMU1_PLLCTL2, 0x05001828);
405 + pmu_ctl = SSB_CHIPCO_PMU_CTL_PLL_UPD;
408 + /* TODO: BCM43222 requires updating PLLs too */
411 + ssb_printk(KERN_ERR PFX
412 + "Unknown spuravoidance settings for chip 0x%04X, not changing PLL\n",
413 + cc->dev->bus->chip_id);
417 + chipco_set32(cc, SSB_CHIPCO_PMU_CTL, pmu_ctl);
419 +EXPORT_SYMBOL_GPL(ssb_pmu_spuravoid_pllupdate);
421 +++ b/drivers/ssb/driver_chipcommon_sflash.c
424 + * Sonics Silicon Backplane
425 + * ChipCommon serial flash interface
427 + * Licensed under the GNU/GPL. See COPYING for details.
430 +#include <linux/ssb/ssb.h>
432 +#include "ssb_private.h"
434 +/* Initialize serial flash access */
435 +int ssb_sflash_init(struct ssb_chipcommon *cc)
437 + pr_err("Serial flash support is not implemented yet!\n");
441 --- a/drivers/ssb/driver_extif.c
442 +++ b/drivers/ssb/driver_extif.c
443 @@ -112,10 +112,37 @@ void ssb_extif_get_clockcontrol(struct s
444 *m = extif_read32(extif, SSB_EXTIF_CLOCK_SB);
447 -void ssb_extif_watchdog_timer_set(struct ssb_extif *extif,
449 +u32 ssb_extif_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt, u32 ticks)
451 + struct ssb_extif *extif = bcm47xx_wdt_get_drvdata(wdt);
453 + return ssb_extif_watchdog_timer_set(extif, ticks);
456 +u32 ssb_extif_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt, u32 ms)
458 + struct ssb_extif *extif = bcm47xx_wdt_get_drvdata(wdt);
459 + u32 ticks = (SSB_EXTIF_WATCHDOG_CLK / 1000) * ms;
461 + ticks = ssb_extif_watchdog_timer_set(extif, ticks);
463 + return (ticks * 1000) / SSB_EXTIF_WATCHDOG_CLK;
466 +u32 ssb_extif_watchdog_timer_set(struct ssb_extif *extif, u32 ticks)
468 + if (ticks > SSB_EXTIF_WATCHDOG_MAX_TIMER)
469 + ticks = SSB_EXTIF_WATCHDOG_MAX_TIMER;
470 extif_write32(extif, SSB_EXTIF_WATCHDOG, ticks);
475 +void ssb_extif_init(struct ssb_extif *extif)
478 + return; /* We don't have a Extif core */
479 + spin_lock_init(&extif->gpio_lock);
482 u32 ssb_extif_gpio_in(struct ssb_extif *extif, u32 mask)
483 @@ -125,22 +152,50 @@ u32 ssb_extif_gpio_in(struct ssb_extif *
485 u32 ssb_extif_gpio_out(struct ssb_extif *extif, u32 mask, u32 value)
487 - return extif_write32_masked(extif, SSB_EXTIF_GPIO_OUT(0),
488 + unsigned long flags;
491 + spin_lock_irqsave(&extif->gpio_lock, flags);
492 + res = extif_write32_masked(extif, SSB_EXTIF_GPIO_OUT(0),
494 + spin_unlock_irqrestore(&extif->gpio_lock, flags);
499 u32 ssb_extif_gpio_outen(struct ssb_extif *extif, u32 mask, u32 value)
501 - return extif_write32_masked(extif, SSB_EXTIF_GPIO_OUTEN(0),
502 + unsigned long flags;
505 + spin_lock_irqsave(&extif->gpio_lock, flags);
506 + res = extif_write32_masked(extif, SSB_EXTIF_GPIO_OUTEN(0),
508 + spin_unlock_irqrestore(&extif->gpio_lock, flags);
513 u32 ssb_extif_gpio_polarity(struct ssb_extif *extif, u32 mask, u32 value)
515 - return extif_write32_masked(extif, SSB_EXTIF_GPIO_INTPOL, mask, value);
516 + unsigned long flags;
519 + spin_lock_irqsave(&extif->gpio_lock, flags);
520 + res = extif_write32_masked(extif, SSB_EXTIF_GPIO_INTPOL, mask, value);
521 + spin_unlock_irqrestore(&extif->gpio_lock, flags);
526 u32 ssb_extif_gpio_intmask(struct ssb_extif *extif, u32 mask, u32 value)
528 - return extif_write32_masked(extif, SSB_EXTIF_GPIO_INTMASK, mask, value);
529 + unsigned long flags;
532 + spin_lock_irqsave(&extif->gpio_lock, flags);
533 + res = extif_write32_masked(extif, SSB_EXTIF_GPIO_INTMASK, mask, value);
534 + spin_unlock_irqrestore(&extif->gpio_lock, flags);
539 +++ b/drivers/ssb/driver_gpio.c
542 + * Sonics Silicon Backplane
545 + * Copyright 2011, Broadcom Corporation
546 + * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
548 + * Licensed under the GNU/GPL. See COPYING for details.
551 +#include <linux/gpio.h>
552 +#include <linux/export.h>
553 +#include <linux/ssb/ssb.h>
555 +#include "ssb_private.h"
557 +static struct ssb_bus *ssb_gpio_get_bus(struct gpio_chip *chip)
559 + return container_of(chip, struct ssb_bus, gpio);
562 +static int ssb_gpio_chipco_get_value(struct gpio_chip *chip, unsigned gpio)
564 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
566 + return !!ssb_chipco_gpio_in(&bus->chipco, 1 << gpio);
569 +static void ssb_gpio_chipco_set_value(struct gpio_chip *chip, unsigned gpio,
572 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
574 + ssb_chipco_gpio_out(&bus->chipco, 1 << gpio, value ? 1 << gpio : 0);
577 +static int ssb_gpio_chipco_direction_input(struct gpio_chip *chip,
580 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
582 + ssb_chipco_gpio_outen(&bus->chipco, 1 << gpio, 0);
586 +static int ssb_gpio_chipco_direction_output(struct gpio_chip *chip,
587 + unsigned gpio, int value)
589 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
591 + ssb_chipco_gpio_outen(&bus->chipco, 1 << gpio, 1 << gpio);
592 + ssb_chipco_gpio_out(&bus->chipco, 1 << gpio, value ? 1 << gpio : 0);
596 +static int ssb_gpio_chipco_request(struct gpio_chip *chip, unsigned gpio)
598 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
600 + ssb_chipco_gpio_control(&bus->chipco, 1 << gpio, 0);
601 + /* clear pulldown */
602 + ssb_chipco_gpio_pulldown(&bus->chipco, 1 << gpio, 0);
604 + ssb_chipco_gpio_pullup(&bus->chipco, 1 << gpio, 1 << gpio);
609 +static void ssb_gpio_chipco_free(struct gpio_chip *chip, unsigned gpio)
611 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
614 + ssb_chipco_gpio_pullup(&bus->chipco, 1 << gpio, 0);
617 +static int ssb_gpio_chipco_init(struct ssb_bus *bus)
619 + struct gpio_chip *chip = &bus->gpio;
621 + chip->label = "ssb_chipco_gpio";
622 + chip->owner = THIS_MODULE;
623 + chip->request = ssb_gpio_chipco_request;
624 + chip->free = ssb_gpio_chipco_free;
625 + chip->get = ssb_gpio_chipco_get_value;
626 + chip->set = ssb_gpio_chipco_set_value;
627 + chip->direction_input = ssb_gpio_chipco_direction_input;
628 + chip->direction_output = ssb_gpio_chipco_direction_output;
630 + /* There is just one SoC in one device and its GPIO addresses should be
631 + * deterministic to address them more easily. The other buses could get
632 + * a random base number. */
633 + if (bus->bustype == SSB_BUSTYPE_SSB)
638 + return gpiochip_add(chip);
641 +#ifdef CONFIG_SSB_DRIVER_EXTIF
643 +static int ssb_gpio_extif_get_value(struct gpio_chip *chip, unsigned gpio)
645 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
647 + return !!ssb_extif_gpio_in(&bus->extif, 1 << gpio);
650 +static void ssb_gpio_extif_set_value(struct gpio_chip *chip, unsigned gpio,
653 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
655 + ssb_extif_gpio_out(&bus->extif, 1 << gpio, value ? 1 << gpio : 0);
658 +static int ssb_gpio_extif_direction_input(struct gpio_chip *chip,
661 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
663 + ssb_extif_gpio_outen(&bus->extif, 1 << gpio, 0);
667 +static int ssb_gpio_extif_direction_output(struct gpio_chip *chip,
668 + unsigned gpio, int value)
670 + struct ssb_bus *bus = ssb_gpio_get_bus(chip);
672 + ssb_extif_gpio_outen(&bus->extif, 1 << gpio, 1 << gpio);
673 + ssb_extif_gpio_out(&bus->extif, 1 << gpio, value ? 1 << gpio : 0);
677 +static int ssb_gpio_extif_init(struct ssb_bus *bus)
679 + struct gpio_chip *chip = &bus->gpio;
681 + chip->label = "ssb_extif_gpio";
682 + chip->owner = THIS_MODULE;
683 + chip->get = ssb_gpio_extif_get_value;
684 + chip->set = ssb_gpio_extif_set_value;
685 + chip->direction_input = ssb_gpio_extif_direction_input;
686 + chip->direction_output = ssb_gpio_extif_direction_output;
688 + /* There is just one SoC in one device and its GPIO addresses should be
689 + * deterministic to address them more easily. The other buses could get
690 + * a random base number. */
691 + if (bus->bustype == SSB_BUSTYPE_SSB)
696 + return gpiochip_add(chip);
700 +static int ssb_gpio_extif_init(struct ssb_bus *bus)
706 +int ssb_gpio_init(struct ssb_bus *bus)
708 + if (ssb_chipco_available(&bus->chipco))
709 + return ssb_gpio_chipco_init(bus);
710 + else if (ssb_extif_available(&bus->extif))
711 + return ssb_gpio_extif_init(bus);
717 --- a/drivers/ssb/driver_mipscore.c
718 +++ b/drivers/ssb/driver_mipscore.c
719 @@ -178,9 +178,9 @@ static void ssb_mips_serial_init(struct
721 struct ssb_bus *bus = mcore->dev->bus;
723 - if (bus->extif.dev)
724 + if (ssb_extif_available(&bus->extif))
725 mcore->nr_serial_ports = ssb_extif_serial_init(&bus->extif, mcore->serial_ports);
726 - else if (bus->chipco.dev)
727 + else if (ssb_chipco_available(&bus->chipco))
728 mcore->nr_serial_ports = ssb_chipco_serial_init(&bus->chipco, mcore->serial_ports);
730 mcore->nr_serial_ports = 0;
731 @@ -190,16 +190,33 @@ static void ssb_mips_flash_detect(struct
733 struct ssb_bus *bus = mcore->dev->bus;
735 - mcore->flash_buswidth = 2;
736 - if (bus->chipco.dev) {
737 - mcore->flash_window = 0x1c000000;
738 - mcore->flash_window_size = 0x02000000;
739 + /* When there is no chipcommon on the bus there is 4MB flash */
740 + if (!ssb_chipco_available(&bus->chipco)) {
741 + mcore->pflash.present = true;
742 + mcore->pflash.buswidth = 2;
743 + mcore->pflash.window = SSB_FLASH1;
744 + mcore->pflash.window_size = SSB_FLASH1_SZ;
748 + /* There is ChipCommon, so use it to read info about flash */
749 + switch (bus->chipco.capabilities & SSB_CHIPCO_CAP_FLASHT) {
750 + case SSB_CHIPCO_FLASHT_STSER:
751 + case SSB_CHIPCO_FLASHT_ATSER:
752 + pr_debug("Found serial flash\n");
753 + ssb_sflash_init(&bus->chipco);
755 + case SSB_CHIPCO_FLASHT_PARA:
756 + pr_debug("Found parallel flash\n");
757 + mcore->pflash.present = true;
758 + mcore->pflash.window = SSB_FLASH2;
759 + mcore->pflash.window_size = SSB_FLASH2_SZ;
760 if ((ssb_read32(bus->chipco.dev, SSB_CHIPCO_FLASH_CFG)
761 & SSB_CHIPCO_CFG_DS16) == 0)
762 - mcore->flash_buswidth = 1;
764 - mcore->flash_window = 0x1fc00000;
765 - mcore->flash_window_size = 0x00400000;
766 + mcore->pflash.buswidth = 1;
768 + mcore->pflash.buswidth = 2;
773 @@ -211,9 +228,9 @@ u32 ssb_cpu_clock(struct ssb_mipscore *m
774 if (bus->chipco.capabilities & SSB_CHIPCO_CAP_PMU)
775 return ssb_pmu_get_cpu_clock(&bus->chipco);
777 - if (bus->extif.dev) {
778 + if (ssb_extif_available(&bus->extif)) {
779 ssb_extif_get_clockcontrol(&bus->extif, &pll_type, &n, &m);
780 - } else if (bus->chipco.dev) {
781 + } else if (ssb_chipco_available(&bus->chipco)) {
782 ssb_chipco_get_clockcpu(&bus->chipco, &pll_type, &n, &m);
785 @@ -249,9 +266,9 @@ void ssb_mipscore_init(struct ssb_mipsco
787 ns = 1000000000 / hz;
789 - if (bus->extif.dev)
790 + if (ssb_extif_available(&bus->extif))
791 ssb_extif_timing_init(&bus->extif, ns);
792 - else if (bus->chipco.dev)
793 + else if (ssb_chipco_available(&bus->chipco))
794 ssb_chipco_timing_init(&bus->chipco, ns);
796 /* Assign IRQs to all cores on the bus, start with irq line 2, because serial usually takes 1 */
797 --- a/drivers/ssb/embedded.c
798 +++ b/drivers/ssb/embedded.c
801 * Copyright 2005-2008, Broadcom Corporation
802 * Copyright 2006-2008, Michael Buesch <m@bues.ch>
803 + * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
805 * Licensed under the GNU/GPL. See COPYING for details.
808 #include <linux/export.h>
809 +#include <linux/platform_device.h>
810 #include <linux/ssb/ssb.h>
811 #include <linux/ssb/ssb_embedded.h>
812 #include <linux/ssb/ssb_driver_pci.h>
813 @@ -32,6 +34,39 @@ int ssb_watchdog_timer_set(struct ssb_bu
815 EXPORT_SYMBOL(ssb_watchdog_timer_set);
817 +int ssb_watchdog_register(struct ssb_bus *bus)
819 + struct bcm47xx_wdt wdt = {};
820 + struct platform_device *pdev;
822 + if (ssb_chipco_available(&bus->chipco)) {
823 + wdt.driver_data = &bus->chipco;
824 + wdt.timer_set = ssb_chipco_watchdog_timer_set_wdt;
825 + wdt.timer_set_ms = ssb_chipco_watchdog_timer_set_ms;
826 + wdt.max_timer_ms = bus->chipco.max_timer_ms;
827 + } else if (ssb_extif_available(&bus->extif)) {
828 + wdt.driver_data = &bus->extif;
829 + wdt.timer_set = ssb_extif_watchdog_timer_set_wdt;
830 + wdt.timer_set_ms = ssb_extif_watchdog_timer_set_ms;
831 + wdt.max_timer_ms = SSB_EXTIF_WATCHDOG_MAX_TIMER_MS;
836 + pdev = platform_device_register_data(NULL, "bcm47xx-wdt",
837 + bus->busnumber, &wdt,
839 + if (IS_ERR(pdev)) {
840 + ssb_dprintk(KERN_INFO PFX
841 + "can not register watchdog device, err: %li\n",
843 + return PTR_ERR(pdev);
846 + bus->watchdog = pdev;
850 u32 ssb_gpio_in(struct ssb_bus *bus, u32 mask)
853 --- a/drivers/ssb/main.c
854 +++ b/drivers/ssb/main.c
856 #include <linux/delay.h>
857 #include <linux/io.h>
858 #include <linux/module.h>
859 +#include <linux/platform_device.h>
860 #include <linux/ssb/ssb.h>
861 #include <linux/ssb/ssb_regs.h>
862 #include <linux/ssb/ssb_driver_gige.h>
863 @@ -433,6 +434,11 @@ static void ssb_devices_unregister(struc
865 device_unregister(sdev->dev);
868 +#ifdef CONFIG_SSB_EMBEDDED
869 + if (bus->bustype == SSB_BUSTYPE_SSB)
870 + platform_device_unregister(bus->watchdog);
874 void ssb_bus_unregister(struct ssb_bus *bus)
875 @@ -561,6 +567,8 @@ static int __devinit ssb_attach_queued_b
878 ssb_pcicore_init(&bus->pcicore);
879 + if (bus->bustype == SSB_BUSTYPE_SSB)
880 + ssb_watchdog_register(bus);
881 ssb_bus_may_powerdown(bus);
883 err = ssb_devices_register(bus);
884 @@ -796,7 +804,14 @@ static int __devinit ssb_bus_register(st
886 goto err_pcmcia_exit;
887 ssb_chipcommon_init(&bus->chipco);
888 + ssb_extif_init(&bus->extif);
889 ssb_mipscore_init(&bus->mipscore);
890 + err = ssb_gpio_init(bus);
891 + if (err == -ENOTSUPP)
892 + ssb_dprintk(KERN_DEBUG PFX "GPIO driver not activated\n");
894 + ssb_dprintk(KERN_ERR PFX
895 + "Error registering GPIO driver: %i\n", err);
896 err = ssb_fetch_invariants(bus, get_invariants);
898 ssb_bus_may_powerdown(bus);
899 @@ -1118,8 +1133,7 @@ static u32 ssb_tmslow_reject_bitmask(str
900 case SSB_IDLOW_SSBREV_27: /* same here */
901 return SSB_TMSLOW_REJECT; /* this is a guess */
903 - printk(KERN_INFO "ssb: Backplane Revision 0x%.8X\n", rev);
905 + WARN(1, KERN_INFO "ssb: Backplane Revision 0x%.8X\n", rev);
907 return (SSB_TMSLOW_REJECT | SSB_TMSLOW_REJECT_23);
909 --- a/drivers/ssb/ssb_private.h
910 +++ b/drivers/ssb/ssb_private.h
913 #include <linux/ssb/ssb.h>
914 #include <linux/types.h>
915 +#include <linux/bcm47xx_wdt.h>
919 @@ -210,5 +211,63 @@ static inline void b43_pci_ssb_bridge_ex
920 /* driver_chipcommon_pmu.c */
921 extern u32 ssb_pmu_get_cpu_clock(struct ssb_chipcommon *cc);
922 extern u32 ssb_pmu_get_controlclock(struct ssb_chipcommon *cc);
923 +extern u32 ssb_pmu_get_alp_clock(struct ssb_chipcommon *cc);
925 +extern u32 ssb_chipco_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt,
927 +extern u32 ssb_chipco_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt, u32 ms);
929 +/* driver_chipcommon_sflash.c */
930 +#ifdef CONFIG_SSB_SFLASH
931 +int ssb_sflash_init(struct ssb_chipcommon *cc);
933 +static inline int ssb_sflash_init(struct ssb_chipcommon *cc)
935 + pr_err("Serial flash not supported\n");
938 +#endif /* CONFIG_SSB_SFLASH */
940 +#ifdef CONFIG_SSB_DRIVER_EXTIF
941 +extern u32 ssb_extif_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt, u32 ticks);
942 +extern u32 ssb_extif_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt, u32 ms);
944 +static inline u32 ssb_extif_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt,
949 +static inline u32 ssb_extif_watchdog_timer_set_ms(struct bcm47xx_wdt *wdt,
956 +#ifdef CONFIG_SSB_EMBEDDED
957 +extern int ssb_watchdog_register(struct ssb_bus *bus);
958 +#else /* CONFIG_SSB_EMBEDDED */
959 +static inline int ssb_watchdog_register(struct ssb_bus *bus)
963 +#endif /* CONFIG_SSB_EMBEDDED */
965 +#ifdef CONFIG_SSB_DRIVER_EXTIF
966 +extern void ssb_extif_init(struct ssb_extif *extif);
968 +static inline void ssb_extif_init(struct ssb_extif *extif)
973 +#ifdef CONFIG_SSB_DRIVER_GPIO
974 +extern int ssb_gpio_init(struct ssb_bus *bus);
975 +#else /* CONFIG_SSB_DRIVER_GPIO */
976 +static inline int ssb_gpio_init(struct ssb_bus *bus)
980 +#endif /* CONFIG_SSB_DRIVER_GPIO */
982 #endif /* LINUX_SSB_PRIVATE_H_ */
983 --- a/include/linux/ssb/ssb.h
984 +++ b/include/linux/ssb/ssb.h
986 #include <linux/types.h>
987 #include <linux/spinlock.h>
988 #include <linux/pci.h>
989 +#include <linux/gpio.h>
990 #include <linux/mod_devicetable.h>
991 #include <linux/dma-mapping.h>
992 +#include <linux/platform_device.h>
994 #include <linux/ssb/ssb_regs.h>
996 @@ -432,7 +434,11 @@ struct ssb_bus {
997 #ifdef CONFIG_SSB_EMBEDDED
998 /* Lock for GPIO register access. */
999 spinlock_t gpio_lock;
1000 + struct platform_device *watchdog;
1001 #endif /* EMBEDDED */
1002 +#ifdef CONFIG_SSB_DRIVER_GPIO
1003 + struct gpio_chip gpio;
1004 +#endif /* DRIVER_GPIO */
1006 /* Internal-only stuff follows. Do not touch. */
1007 struct list_head list;
1008 --- a/include/linux/ssb/ssb_driver_chipcommon.h
1009 +++ b/include/linux/ssb/ssb_driver_chipcommon.h
1011 #define SSB_CHIPCO_PMU_CTL 0x0600 /* PMU control */
1012 #define SSB_CHIPCO_PMU_CTL_ILP_DIV 0xFFFF0000 /* ILP div mask */
1013 #define SSB_CHIPCO_PMU_CTL_ILP_DIV_SHIFT 16
1014 +#define SSB_CHIPCO_PMU_CTL_PLL_UPD 0x00000400
1015 #define SSB_CHIPCO_PMU_CTL_NOILPONW 0x00000200 /* No ILP on wait */
1016 #define SSB_CHIPCO_PMU_CTL_HTREQEN 0x00000100 /* HT req enable */
1017 #define SSB_CHIPCO_PMU_CTL_ALPREQEN 0x00000080 /* ALP req enable */
1019 #define SSB_CHIPCO_FLASHCTL_ST_SE 0x02D8 /* Sector Erase */
1020 #define SSB_CHIPCO_FLASHCTL_ST_BE 0x00C7 /* Bulk Erase */
1021 #define SSB_CHIPCO_FLASHCTL_ST_DP 0x00B9 /* Deep Power-down */
1022 -#define SSB_CHIPCO_FLASHCTL_ST_RSIG 0x03AB /* Read Electronic Signature */
1023 +#define SSB_CHIPCO_FLASHCTL_ST_RES 0x03AB /* Read Electronic Signature */
1024 +#define SSB_CHIPCO_FLASHCTL_ST_CSA 0x1000 /* Keep chip select asserted */
1025 +#define SSB_CHIPCO_FLASHCTL_ST_SSE 0x0220 /* Sub-sector Erase */
1027 /* Status register bits for ST flashes */
1028 #define SSB_CHIPCO_FLASHSTA_ST_WIP 0x01 /* Write In Progress */
1029 @@ -588,7 +591,10 @@ struct ssb_chipcommon {
1031 /* Fast Powerup Delay constant */
1032 u16 fast_pwrup_delay;
1033 + spinlock_t gpio_lock;
1034 struct ssb_chipcommon_pmu pmu;
1039 static inline bool ssb_chipco_available(struct ssb_chipcommon *cc)
1040 @@ -628,8 +634,7 @@ enum ssb_clkmode {
1041 extern void ssb_chipco_set_clockmode(struct ssb_chipcommon *cc,
1042 enum ssb_clkmode mode);
1044 -extern void ssb_chipco_watchdog_timer_set(struct ssb_chipcommon *cc,
1046 +extern u32 ssb_chipco_watchdog_timer_set(struct ssb_chipcommon *cc, u32 ticks);
1048 void ssb_chipco_irq_mask(struct ssb_chipcommon *cc, u32 mask, u32 value);
1050 @@ -642,6 +647,8 @@ u32 ssb_chipco_gpio_outen(struct ssb_chi
1051 u32 ssb_chipco_gpio_control(struct ssb_chipcommon *cc, u32 mask, u32 value);
1052 u32 ssb_chipco_gpio_intmask(struct ssb_chipcommon *cc, u32 mask, u32 value);
1053 u32 ssb_chipco_gpio_polarity(struct ssb_chipcommon *cc, u32 mask, u32 value);
1054 +u32 ssb_chipco_gpio_pullup(struct ssb_chipcommon *cc, u32 mask, u32 value);
1055 +u32 ssb_chipco_gpio_pulldown(struct ssb_chipcommon *cc, u32 mask, u32 value);
1057 #ifdef CONFIG_SSB_SERIAL
1058 extern int ssb_chipco_serial_init(struct ssb_chipcommon *cc,
1059 @@ -661,5 +668,6 @@ enum ssb_pmu_ldo_volt_id {
1060 void ssb_pmu_set_ldo_voltage(struct ssb_chipcommon *cc,
1061 enum ssb_pmu_ldo_volt_id id, u32 voltage);
1062 void ssb_pmu_set_ldo_paref(struct ssb_chipcommon *cc, bool on);
1063 +void ssb_pmu_spuravoid_pllupdate(struct ssb_chipcommon *cc, int spuravoid);
1065 #endif /* LINUX_SSB_CHIPCO_H_ */
1066 --- a/include/linux/ssb/ssb_driver_extif.h
1067 +++ b/include/linux/ssb/ssb_driver_extif.h
1068 @@ -152,12 +152,16 @@
1070 #define SSB_EXTIF_WATCHDOG_CLK 48000000 /* Hz */
1072 +#define SSB_EXTIF_WATCHDOG_MAX_TIMER ((1 << 28) - 1)
1073 +#define SSB_EXTIF_WATCHDOG_MAX_TIMER_MS (SSB_EXTIF_WATCHDOG_MAX_TIMER \
1074 + / (SSB_EXTIF_WATCHDOG_CLK / 1000))
1077 #ifdef CONFIG_SSB_DRIVER_EXTIF
1080 struct ssb_device *dev;
1081 + spinlock_t gpio_lock;
1084 static inline bool ssb_extif_available(struct ssb_extif *extif)
1085 @@ -171,8 +175,7 @@ extern void ssb_extif_get_clockcontrol(s
1086 extern void ssb_extif_timing_init(struct ssb_extif *extif,
1089 -extern void ssb_extif_watchdog_timer_set(struct ssb_extif *extif,
1091 +extern u32 ssb_extif_watchdog_timer_set(struct ssb_extif *extif, u32 ticks);
1093 /* Extif GPIO pin access */
1094 u32 ssb_extif_gpio_in(struct ssb_extif *extif, u32 mask);
1095 @@ -205,10 +208,52 @@ void ssb_extif_get_clockcontrol(struct s
1099 -void ssb_extif_watchdog_timer_set(struct ssb_extif *extif,
1101 +void ssb_extif_timing_init(struct ssb_extif *extif, unsigned long ns)
1106 +u32 ssb_extif_watchdog_timer_set(struct ssb_extif *extif, u32 ticks)
1111 +static inline u32 ssb_extif_gpio_in(struct ssb_extif *extif, u32 mask)
1116 +static inline u32 ssb_extif_gpio_out(struct ssb_extif *extif, u32 mask,
1122 +static inline u32 ssb_extif_gpio_outen(struct ssb_extif *extif, u32 mask,
1128 +static inline u32 ssb_extif_gpio_polarity(struct ssb_extif *extif, u32 mask,
1134 +static inline u32 ssb_extif_gpio_intmask(struct ssb_extif *extif, u32 mask,
1140 +#ifdef CONFIG_SSB_SERIAL
1141 +static inline int ssb_extif_serial_init(struct ssb_extif *extif,
1142 + struct ssb_serial_port *ports)
1146 +#endif /* CONFIG_SSB_SERIAL */
1148 #endif /* CONFIG_SSB_DRIVER_EXTIF */
1149 #endif /* LINUX_SSB_EXTIFCORE_H_ */
1150 --- a/include/linux/ssb/ssb_driver_mips.h
1151 +++ b/include/linux/ssb/ssb_driver_mips.h
1152 @@ -13,6 +13,12 @@ struct ssb_serial_port {
1153 unsigned int reg_shift;
1156 +struct ssb_pflash {
1163 struct ssb_mipscore {
1164 struct ssb_device *dev;
1165 @@ -20,9 +26,7 @@ struct ssb_mipscore {
1166 int nr_serial_ports;
1167 struct ssb_serial_port serial_ports[4];
1169 - u8 flash_buswidth;
1171 - u32 flash_window_size;
1172 + struct ssb_pflash pflash;
1175 extern void ssb_mipscore_init(struct ssb_mipscore *mcore);
1176 --- a/include/linux/ssb/ssb_regs.h
1177 +++ b/include/linux/ssb/ssb_regs.h
1178 @@ -289,11 +289,11 @@
1179 #define SSB_SPROM4_ETHPHY_ET1A_SHIFT 5
1180 #define SSB_SPROM4_ETHPHY_ET0M (1<<14) /* MDIO for enet0 */
1181 #define SSB_SPROM4_ETHPHY_ET1M (1<<15) /* MDIO for enet1 */
1182 -#define SSB_SPROM4_ANTAVAIL 0x005D /* Antenna available bitfields */
1183 -#define SSB_SPROM4_ANTAVAIL_A 0x00FF /* A-PHY bitfield */
1184 -#define SSB_SPROM4_ANTAVAIL_A_SHIFT 0
1185 -#define SSB_SPROM4_ANTAVAIL_BG 0xFF00 /* B-PHY and G-PHY bitfield */
1186 -#define SSB_SPROM4_ANTAVAIL_BG_SHIFT 8
1187 +#define SSB_SPROM4_ANTAVAIL 0x005C /* Antenna available bitfields */
1188 +#define SSB_SPROM4_ANTAVAIL_BG 0x00FF /* B-PHY and G-PHY bitfield */
1189 +#define SSB_SPROM4_ANTAVAIL_BG_SHIFT 0
1190 +#define SSB_SPROM4_ANTAVAIL_A 0xFF00 /* A-PHY bitfield */
1191 +#define SSB_SPROM4_ANTAVAIL_A_SHIFT 8
1192 #define SSB_SPROM4_AGAIN01 0x005E /* Antenna Gain (in dBm Q5.2) */
1193 #define SSB_SPROM4_AGAIN0 0x00FF /* Antenna 0 */
1194 #define SSB_SPROM4_AGAIN0_SHIFT 0
1196 #define SSB_SPROM8_HWIQ_IQSWP_IQCAL_SWP_SHIFT 4
1197 #define SSB_SPROM8_HWIQ_IQSWP_HW_IQCAL 0x0020
1198 #define SSB_SPROM8_HWIQ_IQSWP_HW_IQCAL_SHIFT 5
1199 -#define SSB_SPROM8_TEMPDELTA 0x00BA
1200 +#define SSB_SPROM8_TEMPDELTA 0x00BC
1201 #define SSB_SPROM8_TEMPDELTA_PHYCAL 0x00ff
1202 #define SSB_SPROM8_TEMPDELTA_PHYCAL_SHIFT 0
1203 #define SSB_SPROM8_TEMPDELTA_PERIOD 0x0f00
1205 +++ b/include/linux/bcm47xx_wdt.h
1207 +#ifndef LINUX_BCM47XX_WDT_H_
1208 +#define LINUX_BCM47XX_WDT_H_
1210 +#include <linux/types.h>
1213 +struct bcm47xx_wdt {
1214 + u32 (*timer_set)(struct bcm47xx_wdt *, u32);
1215 + u32 (*timer_set_ms)(struct bcm47xx_wdt *, u32);
1218 + void *driver_data;
1221 +static inline void *bcm47xx_wdt_get_drvdata(struct bcm47xx_wdt *wdt)
1223 + return wdt->driver_data;
1225 +#endif /* LINUX_BCM47XX_WDT_H_ */
1226 --- a/drivers/net/wireless/b43/phy_n.c
1227 +++ b/drivers/net/wireless/b43/phy_n.c
1228 @@ -4583,7 +4583,8 @@ static void b43_nphy_pmu_spur_avoid(stru
1230 #ifdef CONFIG_B43_SSB
1233 + ssb_pmu_spuravoid_pllupdate(&dev->dev->sdev->bus->chipco,
1238 --- a/drivers/ssb/pci.c
1239 +++ b/drivers/ssb/pci.c
1240 @@ -339,6 +339,21 @@ static s8 r123_extract_antgain(u8 sprom_
1244 +static void sprom_extract_r23(struct ssb_sprom *out, const u16 *in)
1246 + SPEX(boardflags_hi, SSB_SPROM2_BFLHI, 0xFFFF, 0);
1247 + SPEX(opo, SSB_SPROM2_OPO, SSB_SPROM2_OPO_VALUE, 0);
1248 + SPEX(pa1lob0, SSB_SPROM2_PA1LOB0, 0xFFFF, 0);
1249 + SPEX(pa1lob1, SSB_SPROM2_PA1LOB1, 0xFFFF, 0);
1250 + SPEX(pa1lob2, SSB_SPROM2_PA1LOB2, 0xFFFF, 0);
1251 + SPEX(pa1hib0, SSB_SPROM2_PA1HIB0, 0xFFFF, 0);
1252 + SPEX(pa1hib1, SSB_SPROM2_PA1HIB1, 0xFFFF, 0);
1253 + SPEX(pa1hib2, SSB_SPROM2_PA1HIB2, 0xFFFF, 0);
1254 + SPEX(maxpwr_ah, SSB_SPROM2_MAXP_A, SSB_SPROM2_MAXP_A_HI, 0);
1255 + SPEX(maxpwr_al, SSB_SPROM2_MAXP_A, SSB_SPROM2_MAXP_A_LO,
1256 + SSB_SPROM2_MAXP_A_LO_SHIFT);
1259 static void sprom_extract_r123(struct ssb_sprom *out, const u16 *in)
1262 @@ -398,8 +413,7 @@ static void sprom_extract_r123(struct ss
1263 SSB_SPROM1_ITSSI_A_SHIFT);
1264 SPEX(itssi_bg, SSB_SPROM1_ITSSI, SSB_SPROM1_ITSSI_BG, 0);
1265 SPEX(boardflags_lo, SSB_SPROM1_BFLLO, 0xFFFF, 0);
1266 - if (out->revision >= 2)
1267 - SPEX(boardflags_hi, SSB_SPROM2_BFLHI, 0xFFFF, 0);
1269 SPEX(alpha2[0], SSB_SPROM1_CCODE, 0xff00, 8);
1270 SPEX(alpha2[1], SSB_SPROM1_CCODE, 0x00ff, 0);
1272 @@ -410,6 +424,8 @@ static void sprom_extract_r123(struct ss
1273 out->antenna_gain.a1 = r123_extract_antgain(out->revision, in,
1275 SSB_SPROM1_AGAIN_A_SHIFT);
1276 + if (out->revision >= 2)
1277 + sprom_extract_r23(out, in);
1280 /* Revs 4 5 and 8 have partially shared layout */