kernel: backport SSB/BCMA changes in preparation for a compat-wireless update
[openwrt.git] / target / linux / generic / patches-3.6 / 025-bcma_backport.patch
index 15f54a3..36f30de 100644 (file)
        default y
  
  config BCMA_DRIVER_GMAC_CMN
+@@ -65,6 +65,14 @@ config BCMA_DRIVER_GMAC_CMN
+         If unsure, say N
++config BCMA_DRIVER_GPIO
++      bool "BCMA GPIO driver"
++      depends on BCMA && GPIOLIB
++      help
++        Driver to provide access to the GPIO pins of the bcma bus.
++
++        If unsure, say N
++
+ config BCMA_DEBUG
+       bool "BCMA debugging"
+       depends on BCMA
+--- a/drivers/bcma/Makefile
++++ b/drivers/bcma/Makefile
+@@ -6,6 +6,7 @@ bcma-y                                 += driver_pci.o
+ bcma-$(CONFIG_BCMA_DRIVER_PCI_HOSTMODE)       += driver_pci_host.o
+ bcma-$(CONFIG_BCMA_DRIVER_MIPS)               += driver_mips.o
+ bcma-$(CONFIG_BCMA_DRIVER_GMAC_CMN)   += driver_gmac_cmn.o
++bcma-$(CONFIG_BCMA_DRIVER_GPIO)               += driver_gpio.o
+ bcma-$(CONFIG_BCMA_HOST_PCI)          += host_pci.o
+ bcma-$(CONFIG_BCMA_HOST_SOC)          += host_soc.o
+ obj-$(CONFIG_BCMA)                    += bcma.o
 --- a/drivers/bcma/bcma_private.h
 +++ b/drivers/bcma/bcma_private.h
-@@ -54,6 +54,7 @@ u32 bcma_pmu_get_clockcpu(struct bcma_dr
+@@ -31,6 +31,8 @@ int __init bcma_bus_early_register(struc
+ int bcma_bus_suspend(struct bcma_bus *bus);
+ int bcma_bus_resume(struct bcma_bus *bus);
+ #endif
++struct bcma_device *bcma_find_core_unit(struct bcma_bus *bus, u16 coreid,
++                                      u8 unit);
+ /* scan.c */
+ int bcma_bus_scan(struct bcma_bus *bus);
+@@ -48,12 +50,13 @@ void bcma_chipco_serial_init(struct bcma
+ #endif /* CONFIG_BCMA_DRIVER_MIPS */
+ /* driver_chipcommon_pmu.c */
+-u32 bcma_pmu_alp_clock(struct bcma_drv_cc *cc);
+-u32 bcma_pmu_get_clockcpu(struct bcma_drv_cc *cc);
++u32 bcma_pmu_get_alp_clock(struct bcma_drv_cc *cc);
++u32 bcma_pmu_get_cpu_clock(struct bcma_drv_cc *cc);
  #ifdef CONFIG_BCMA_SFLASH
  /* driver_chipcommon_sflash.c */
  int bcma_sflash_init(struct bcma_drv_cc *cc);
@@ -25,7 +67,7 @@
  #else
  static inline int bcma_sflash_init(struct bcma_drv_cc *cc)
  {
-@@ -65,6 +66,7 @@ static inline int bcma_sflash_init(struc
+@@ -65,6 +68,7 @@ static inline int bcma_sflash_init(struc
  #ifdef CONFIG_BCMA_NFLASH
  /* driver_chipcommon_nflash.c */
  int bcma_nflash_init(struct bcma_drv_cc *cc);
  #else
  static inline int bcma_nflash_init(struct bcma_drv_cc *cc)
  {
+@@ -82,9 +86,21 @@ extern void __exit bcma_host_pci_exit(vo
+ /* driver_pci.c */
+ u32 bcma_pcie_read(struct bcma_drv_pci *pc, u32 address);
++extern int bcma_chipco_watchdog_register(struct bcma_drv_cc *cc);
++
+ #ifdef CONFIG_BCMA_DRIVER_PCI_HOSTMODE
+ bool __devinit bcma_core_pci_is_in_hostmode(struct bcma_drv_pci *pc);
+ void __devinit bcma_core_pci_hostmode_init(struct bcma_drv_pci *pc);
+ #endif /* CONFIG_BCMA_DRIVER_PCI_HOSTMODE */
++#ifdef CONFIG_BCMA_DRIVER_GPIO
++/* driver_gpio.c */
++int bcma_gpio_init(struct bcma_drv_cc *cc);
++#else
++static inline int bcma_gpio_init(struct bcma_drv_cc *cc)
++{
++      return -ENOTSUPP;
++}
++#endif /* CONFIG_BCMA_DRIVER_GPIO */
++
+ #endif
 --- a/drivers/bcma/core.c
 +++ b/drivers/bcma/core.c
 @@ -65,7 +65,7 @@ void bcma_core_set_clockmode(struct bcma
                            BCMA_CLKCTLST_HAVEHT) {
 --- a/drivers/bcma/driver_chipcommon.c
 +++ b/drivers/bcma/driver_chipcommon.c
-@@ -22,12 +22,9 @@ static inline u32 bcma_cc_write32_masked
+@@ -4,12 +4,15 @@
+  *
+  * Copyright 2005, Broadcom Corporation
+  * Copyright 2006, 2007, Michael Buesch <m@bues.ch>
++ * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
+  *
+  * Licensed under the GNU/GPL. See COPYING for details.
+  */
+ #include "bcma_private.h"
++#include <linux/bcm47xx_wdt.h>
+ #include <linux/export.h>
++#include <linux/platform_device.h>
+ #include <linux/bcma/bcma.h>
+ static inline u32 bcma_cc_write32_masked(struct bcma_drv_cc *cc, u16 offset,
+@@ -22,20 +25,120 @@ static inline u32 bcma_cc_write32_masked
        return value;
  }
  
 -void bcma_core_chipcommon_init(struct bcma_drv_cc *cc)
-+void bcma_core_chipcommon_early_init(struct bcma_drv_cc *cc)
++u32 bcma_chipco_get_alp_clock(struct bcma_drv_cc *cc)
  {
 -      u32 leddc_on = 10;
 -      u32 leddc_off = 90;
--
++      if (cc->capabilities & BCMA_CC_CAP_PMU)
++              return bcma_pmu_get_alp_clock(cc);
 -      if (cc->setup_done)
++      return 20000000;
++}
++EXPORT_SYMBOL_GPL(bcma_chipco_get_alp_clock);
++
++static u32 bcma_chipco_watchdog_get_max_timer(struct bcma_drv_cc *cc)
++{
++      struct bcma_bus *bus = cc->core->bus;
++      u32 nb;
++
++      if (cc->capabilities & BCMA_CC_CAP_PMU) {
++              if (bus->chipinfo.id == BCMA_CHIP_ID_BCM4706)
++                      nb = 32;
++              else if (cc->core->id.rev < 26)
++                      nb = 16;
++              else
++                      nb = (cc->core->id.rev >= 37) ? 32 : 24;
++      } else {
++              nb = 28;
++      }
++      if (nb == 32)
++              return 0xffffffff;
++      else
++              return (1 << nb) - 1;
++}
++
++static u32 bcma_chipco_watchdog_timer_set_wdt(struct bcm47xx_wdt *wdt,
++                                            u32 ticks)
++{
++      struct bcma_drv_cc *cc = bcm47xx_wdt_get_drvdata(wdt);
++
++      return bcma_chipco_watchdog_timer_set(cc, ticks);
++}
++
++static u32 bcma_chipco_watchdog_timer_set_ms_wdt(struct bcm47xx_wdt *wdt,
++                                               u32 ms)
++{
++      struct bcma_drv_cc *cc = bcm47xx_wdt_get_drvdata(wdt);
++      u32 ticks;
++
++      ticks = bcma_chipco_watchdog_timer_set(cc, cc->ticks_per_ms * ms);
++      return ticks / cc->ticks_per_ms;
++}
++
++static int bcma_chipco_watchdog_ticks_per_ms(struct bcma_drv_cc *cc)
++{
++      struct bcma_bus *bus = cc->core->bus;
++
++      if (cc->capabilities & BCMA_CC_CAP_PMU) {
++              if (bus->chipinfo.id == BCMA_CHIP_ID_BCM4706)
++                      /* 4706 CC and PMU watchdogs are clocked at 1/4 of ALP clock */
++                      return bcma_chipco_get_alp_clock(cc) / 4000;
++              else
++                      /* based on 32KHz ILP clock */
++                      return 32;
++      } else {
++              return bcma_chipco_get_alp_clock(cc) / 1000;
++      }
++}
++
++int bcma_chipco_watchdog_register(struct bcma_drv_cc *cc)
++{
++      struct bcm47xx_wdt wdt = {};
++      struct platform_device *pdev;
++
++      wdt.driver_data = cc;
++      wdt.timer_set = bcma_chipco_watchdog_timer_set_wdt;
++      wdt.timer_set_ms = bcma_chipco_watchdog_timer_set_ms_wdt;
++      wdt.max_timer_ms = bcma_chipco_watchdog_get_max_timer(cc) / cc->ticks_per_ms;
++
++      pdev = platform_device_register_data(NULL, "bcm47xx-wdt",
++                                           cc->core->bus->num, &wdt,
++                                           sizeof(wdt));
++      if (IS_ERR(pdev))
++              return PTR_ERR(pdev);
++
++      cc->watchdog = pdev;
++
++      return 0;
++}
++
++void bcma_core_chipcommon_early_init(struct bcma_drv_cc *cc)
++{
 +      if (cc->early_setup_done)
                return;
  
++      spin_lock_init(&cc->gpio_lock);
++
        if (cc->core->id.rev >= 11)
-@@ -36,6 +33,22 @@ void bcma_core_chipcommon_init(struct bc
+               cc->status = bcma_cc_read32(cc, BCMA_CC_CHIPSTAT);
+       cc->capabilities = bcma_cc_read32(cc, BCMA_CC_CAP);
        if (cc->core->id.rev >= 35)
                cc->capabilities_ext = bcma_cc_read32(cc, BCMA_CC_CAP_EXT);
  
        if (cc->core->id.rev >= 20) {
                bcma_cc_write32(cc, BCMA_CC_GPIOPULLUP, 0);
                bcma_cc_write32(cc, BCMA_CC_GPIOPULLDOWN, 0);
+@@ -56,15 +159,33 @@ void bcma_core_chipcommon_init(struct bc
+                       ((leddc_on << BCMA_CC_GPIOTIMER_ONTIME_SHIFT) |
+                        (leddc_off << BCMA_CC_GPIOTIMER_OFFTIME_SHIFT)));
+       }
++      cc->ticks_per_ms = bcma_chipco_watchdog_ticks_per_ms(cc);
+       cc->setup_done = true;
+ }
+ /* Set chip watchdog reset timer to fire in 'ticks' backplane cycles */
+-void bcma_chipco_watchdog_timer_set(struct bcma_drv_cc *cc, u32 ticks)
++u32 bcma_chipco_watchdog_timer_set(struct bcma_drv_cc *cc, u32 ticks)
+ {
+-      /* instant NMI */
+-      bcma_cc_write32(cc, BCMA_CC_WATCHDOG, ticks);
++      u32 maxt;
++      enum bcma_clkmode clkmode;
++
++      maxt = bcma_chipco_watchdog_get_max_timer(cc);
++      if (cc->capabilities & BCMA_CC_CAP_PMU) {
++              if (ticks == 1)
++                      ticks = 2;
++              else if (ticks > maxt)
++                      ticks = maxt;
++              bcma_cc_write32(cc, BCMA_CC_PMU_WATCHDOG, ticks);
++      } else {
++              clkmode = ticks ? BCMA_CLKMODE_FAST : BCMA_CLKMODE_DYNAMIC;
++              bcma_core_set_clockmode(cc->core, clkmode);
++              if (ticks > maxt)
++                      ticks = maxt;
++              /* instant NMI */
++              bcma_cc_write32(cc, BCMA_CC_WATCHDOG, ticks);
++      }
++      return ticks;
+ }
+ void bcma_chipco_irq_mask(struct bcma_drv_cc *cc, u32 mask, u32 value)
+@@ -84,28 +205,99 @@ u32 bcma_chipco_gpio_in(struct bcma_drv_
+ u32 bcma_chipco_gpio_out(struct bcma_drv_cc *cc, u32 mask, u32 value)
+ {
+-      return bcma_cc_write32_masked(cc, BCMA_CC_GPIOOUT, mask, value);
++      unsigned long flags;
++      u32 res;
++
++      spin_lock_irqsave(&cc->gpio_lock, flags);
++      res = bcma_cc_write32_masked(cc, BCMA_CC_GPIOOUT, mask, value);
++      spin_unlock_irqrestore(&cc->gpio_lock, flags);
++
++      return res;
+ }
++EXPORT_SYMBOL_GPL(bcma_chipco_gpio_out);
+ u32 bcma_chipco_gpio_outen(struct bcma_drv_cc *cc, u32 mask, u32 value)
+ {
+-      return bcma_cc_write32_masked(cc, BCMA_CC_GPIOOUTEN, mask, value);
++      unsigned long flags;
++      u32 res;
++
++      spin_lock_irqsave(&cc->gpio_lock, flags);
++      res = bcma_cc_write32_masked(cc, BCMA_CC_GPIOOUTEN, mask, value);
++      spin_unlock_irqrestore(&cc->gpio_lock, flags);
++
++      return res;
+ }
++EXPORT_SYMBOL_GPL(bcma_chipco_gpio_outen);
++/*
++ * If the bit is set to 0, chipcommon controlls this GPIO,
++ * if the bit is set to 1, it is used by some part of the chip and not our code.
++ */
+ u32 bcma_chipco_gpio_control(struct bcma_drv_cc *cc, u32 mask, u32 value)
+ {
+-      return bcma_cc_write32_masked(cc, BCMA_CC_GPIOCTL, mask, value);
++      unsigned long flags;
++      u32 res;
++
++      spin_lock_irqsave(&cc->gpio_lock, flags);
++      res = bcma_cc_write32_masked(cc, BCMA_CC_GPIOCTL, mask, value);
++      spin_unlock_irqrestore(&cc->gpio_lock, flags);
++
++      return res;
+ }
+ EXPORT_SYMBOL_GPL(bcma_chipco_gpio_control);
+ u32 bcma_chipco_gpio_intmask(struct bcma_drv_cc *cc, u32 mask, u32 value)
+ {
+-      return bcma_cc_write32_masked(cc, BCMA_CC_GPIOIRQ, mask, value);
++      unsigned long flags;
++      u32 res;
++
++      spin_lock_irqsave(&cc->gpio_lock, flags);
++      res = bcma_cc_write32_masked(cc, BCMA_CC_GPIOIRQ, mask, value);
++      spin_unlock_irqrestore(&cc->gpio_lock, flags);
++
++      return res;
+ }
+ u32 bcma_chipco_gpio_polarity(struct bcma_drv_cc *cc, u32 mask, u32 value)
+ {
+-      return bcma_cc_write32_masked(cc, BCMA_CC_GPIOPOL, mask, value);
++      unsigned long flags;
++      u32 res;
++
++      spin_lock_irqsave(&cc->gpio_lock, flags);
++      res = bcma_cc_write32_masked(cc, BCMA_CC_GPIOPOL, mask, value);
++      spin_unlock_irqrestore(&cc->gpio_lock, flags);
++
++      return res;
++}
++
++u32 bcma_chipco_gpio_pullup(struct bcma_drv_cc *cc, u32 mask, u32 value)
++{
++      unsigned long flags;
++      u32 res;
++
++      if (cc->core->id.rev < 20)
++              return 0;
++
++      spin_lock_irqsave(&cc->gpio_lock, flags);
++      res = bcma_cc_write32_masked(cc, BCMA_CC_GPIOPULLUP, mask, value);
++      spin_unlock_irqrestore(&cc->gpio_lock, flags);
++
++      return res;
++}
++
++u32 bcma_chipco_gpio_pulldown(struct bcma_drv_cc *cc, u32 mask, u32 value)
++{
++      unsigned long flags;
++      u32 res;
++
++      if (cc->core->id.rev < 20)
++              return 0;
++
++      spin_lock_irqsave(&cc->gpio_lock, flags);
++      res = bcma_cc_write32_masked(cc, BCMA_CC_GPIOPULLDOWN, mask, value);
++      spin_unlock_irqrestore(&cc->gpio_lock, flags);
++
++      return res;
+ }
+ #ifdef CONFIG_BCMA_DRIVER_MIPS
+@@ -118,8 +310,7 @@ void bcma_chipco_serial_init(struct bcma
+       struct bcma_serial_port *ports = cc->serial_ports;
+       if (ccrev >= 11 && ccrev != 15) {
+-              /* Fixed ALP clock */
+-              baud_base = bcma_pmu_alp_clock(cc);
++              baud_base = bcma_chipco_get_alp_clock(cc);
+               if (ccrev >= 21) {
+                       /* Turn off UART clock before switching clocksource. */
+                       bcma_cc_write32(cc, BCMA_CC_CORECTL,
 --- a/drivers/bcma/driver_chipcommon_nflash.c
 +++ b/drivers/bcma/driver_chipcommon_nflash.c
 @@ -5,15 +5,40 @@
  }
 --- a/drivers/bcma/driver_chipcommon_pmu.c
 +++ b/drivers/bcma/driver_chipcommon_pmu.c
-@@ -76,7 +76,10 @@ static void bcma_pmu_resources_init(stru
+@@ -13,12 +13,13 @@
+ #include <linux/export.h>
+ #include <linux/bcma/bcma.h>
+-static u32 bcma_chipco_pll_read(struct bcma_drv_cc *cc, u32 offset)
++u32 bcma_chipco_pll_read(struct bcma_drv_cc *cc, u32 offset)
+ {
+       bcma_cc_write32(cc, BCMA_CC_PLLCTL_ADDR, offset);
+       bcma_cc_read32(cc, BCMA_CC_PLLCTL_ADDR);
+       return bcma_cc_read32(cc, BCMA_CC_PLLCTL_DATA);
+ }
++EXPORT_SYMBOL_GPL(bcma_chipco_pll_read);
+ void bcma_chipco_pll_write(struct bcma_drv_cc *cc, u32 offset, u32 value)
+ {
+@@ -76,7 +77,10 @@ static void bcma_pmu_resources_init(stru
        if (max_msk)
                bcma_cc_write32(cc, BCMA_CC_PMU_MAXRES_MSK, max_msk);
  
        mdelay(2);
  }
  
-@@ -101,7 +104,7 @@ void bcma_chipco_bcm4331_ext_pa_lines_ct
+@@ -101,7 +105,7 @@ void bcma_chipco_bcm4331_ext_pa_lines_ct
        bcma_cc_write32(cc, BCMA_CC_CHIPCTL, val);
  }
  
  {
        struct bcma_bus *bus = cc->core->bus;
  
-@@ -141,7 +144,7 @@ void bcma_pmu_workarounds(struct bcma_dr
+@@ -141,7 +145,7 @@ void bcma_pmu_workarounds(struct bcma_dr
        }
  }
  
  {
        u32 pmucap;
  
-@@ -150,7 +153,10 @@ void bcma_pmu_init(struct bcma_drv_cc *c
+@@ -150,7 +154,10 @@ void bcma_pmu_init(struct bcma_drv_cc *c
  
        bcma_debug(cc->core->bus, "Found rev %u PMU (capabilities 0x%08X)\n",
                   cc->pmu.rev, pmucap);
        if (cc->pmu.rev == 1)
                bcma_cc_mask32(cc, BCMA_CC_PMU_CTL,
                              ~BCMA_CC_PMU_CTL_NOILPONW);
-@@ -257,7 +263,7 @@ static u32 bcma_pmu_clock_bcm4706(struct
+@@ -162,24 +169,40 @@ void bcma_pmu_init(struct bcma_drv_cc *c
+       bcma_pmu_workarounds(cc);
+ }
+-u32 bcma_pmu_alp_clock(struct bcma_drv_cc *cc)
++u32 bcma_pmu_get_alp_clock(struct bcma_drv_cc *cc)
+ {
+       struct bcma_bus *bus = cc->core->bus;
+       switch (bus->chipinfo.id) {
++      case BCMA_CHIP_ID_BCM4313:
++      case BCMA_CHIP_ID_BCM43224:
++      case BCMA_CHIP_ID_BCM43225:
++      case BCMA_CHIP_ID_BCM43227:
++      case BCMA_CHIP_ID_BCM43228:
++      case BCMA_CHIP_ID_BCM4331:
++      case BCMA_CHIP_ID_BCM43421:
++      case BCMA_CHIP_ID_BCM43428:
++      case BCMA_CHIP_ID_BCM43431:
+       case BCMA_CHIP_ID_BCM4716:
+-      case BCMA_CHIP_ID_BCM4748:
+       case BCMA_CHIP_ID_BCM47162:
+-      case BCMA_CHIP_ID_BCM4313:
+-      case BCMA_CHIP_ID_BCM5357:
++      case BCMA_CHIP_ID_BCM4748:
+       case BCMA_CHIP_ID_BCM4749:
++      case BCMA_CHIP_ID_BCM5357:
+       case BCMA_CHIP_ID_BCM53572:
++      case BCMA_CHIP_ID_BCM6362:
+               /* always 20Mhz */
+               return 20000 * 1000;
+-      case BCMA_CHIP_ID_BCM5356:
+       case BCMA_CHIP_ID_BCM4706:
++      case BCMA_CHIP_ID_BCM5356:
+               /* always 25Mhz */
+               return 25000 * 1000;
++      case BCMA_CHIP_ID_BCM43460:
++      case BCMA_CHIP_ID_BCM4352:
++      case BCMA_CHIP_ID_BCM4360:
++              if (cc->status & BCMA_CC_CHIPST_4360_XTAL_40MZ)
++                      return 40000 * 1000;
++              else
++                      return 20000 * 1000;
+       default:
+               bcma_warn(bus, "No ALP clock specified for %04X device, pmu rev. %d, using default %d Hz\n",
+                         bus->chipinfo.id, cc->pmu.rev, BCMA_CC_PMU_ALP_CLOCK);
+@@ -190,7 +213,7 @@ u32 bcma_pmu_alp_clock(struct bcma_drv_c
+ /* Find the output of the "m" pll divider given pll controls that start with
+  * pllreg "pll0" i.e. 12 for main 6 for phy, 0 for misc.
+  */
+-static u32 bcma_pmu_clock(struct bcma_drv_cc *cc, u32 pll0, u32 m)
++static u32 bcma_pmu_pll_clock(struct bcma_drv_cc *cc, u32 pll0, u32 m)
+ {
+       u32 tmp, div, ndiv, p1, p2, fc;
+       struct bcma_bus *bus = cc->core->bus;
+@@ -219,14 +242,14 @@ static u32 bcma_pmu_clock(struct bcma_dr
+       ndiv = (tmp & BCMA_CC_PPL_NDIV_MASK) >> BCMA_CC_PPL_NDIV_SHIFT;
+       /* Do calculation in Mhz */
+-      fc = bcma_pmu_alp_clock(cc) / 1000000;
++      fc = bcma_pmu_get_alp_clock(cc) / 1000000;
+       fc = (p1 * ndiv * fc) / p2;
+       /* Return clock in Hertz */
+       return (fc / div) * 1000000;
+ }
+-static u32 bcma_pmu_clock_bcm4706(struct bcma_drv_cc *cc, u32 pll0, u32 m)
++static u32 bcma_pmu_pll_clock_bcm4706(struct bcma_drv_cc *cc, u32 pll0, u32 m)
+ {
+       u32 tmp, ndiv, p1div, p2div;
+       u32 clock;
+@@ -257,7 +280,7 @@ static u32 bcma_pmu_clock_bcm4706(struct
  }
  
  /* query bus clock frequency for PMU-enabled chipcommon */
 -u32 bcma_pmu_get_clockcontrol(struct bcma_drv_cc *cc)
-+static u32 bcma_pmu_get_clockcontrol(struct bcma_drv_cc *cc)
++static u32 bcma_pmu_get_bus_clock(struct bcma_drv_cc *cc)
+ {
+       struct bcma_bus *bus = cc->core->bus;
+@@ -265,40 +288,42 @@ u32 bcma_pmu_get_clockcontrol(struct bcm
+       case BCMA_CHIP_ID_BCM4716:
+       case BCMA_CHIP_ID_BCM4748:
+       case BCMA_CHIP_ID_BCM47162:
+-              return bcma_pmu_clock(cc, BCMA_CC_PMU4716_MAINPLL_PLL0,
+-                                    BCMA_CC_PMU5_MAINPLL_SSB);
++              return bcma_pmu_pll_clock(cc, BCMA_CC_PMU4716_MAINPLL_PLL0,
++                                        BCMA_CC_PMU5_MAINPLL_SSB);
+       case BCMA_CHIP_ID_BCM5356:
+-              return bcma_pmu_clock(cc, BCMA_CC_PMU5356_MAINPLL_PLL0,
+-                                    BCMA_CC_PMU5_MAINPLL_SSB);
++              return bcma_pmu_pll_clock(cc, BCMA_CC_PMU5356_MAINPLL_PLL0,
++                                        BCMA_CC_PMU5_MAINPLL_SSB);
+       case BCMA_CHIP_ID_BCM5357:
+       case BCMA_CHIP_ID_BCM4749:
+-              return bcma_pmu_clock(cc, BCMA_CC_PMU5357_MAINPLL_PLL0,
+-                                    BCMA_CC_PMU5_MAINPLL_SSB);
++              return bcma_pmu_pll_clock(cc, BCMA_CC_PMU5357_MAINPLL_PLL0,
++                                        BCMA_CC_PMU5_MAINPLL_SSB);
+       case BCMA_CHIP_ID_BCM4706:
+-              return bcma_pmu_clock_bcm4706(cc, BCMA_CC_PMU4706_MAINPLL_PLL0,
+-                                            BCMA_CC_PMU5_MAINPLL_SSB);
++              return bcma_pmu_pll_clock_bcm4706(cc,
++                                                BCMA_CC_PMU4706_MAINPLL_PLL0,
++                                                BCMA_CC_PMU5_MAINPLL_SSB);
+       case BCMA_CHIP_ID_BCM53572:
+               return 75000000;
+       default:
+-              bcma_warn(bus, "No backplane clock specified for %04X device, pmu rev. %d, using default %d Hz\n",
++              bcma_warn(bus, "No bus clock specified for %04X device, pmu rev. %d, using default %d Hz\n",
+                         bus->chipinfo.id, cc->pmu.rev, BCMA_CC_PMU_HT_CLOCK);
+       }
+       return BCMA_CC_PMU_HT_CLOCK;
+ }
+ /* query cpu clock frequency for PMU-enabled chipcommon */
+-u32 bcma_pmu_get_clockcpu(struct bcma_drv_cc *cc)
++u32 bcma_pmu_get_cpu_clock(struct bcma_drv_cc *cc)
  {
        struct bcma_bus *bus = cc->core->bus;
  
+       if (bus->chipinfo.id == BCMA_CHIP_ID_BCM53572)
+               return 300000000;
++      /* New PMUs can have different clock for bus and CPU */
+       if (cc->pmu.rev >= 5) {
+               u32 pll;
+               switch (bus->chipinfo.id) {
+               case BCMA_CHIP_ID_BCM4706:
+-                      return bcma_pmu_clock_bcm4706(cc,
++                      return bcma_pmu_pll_clock_bcm4706(cc,
+                                               BCMA_CC_PMU4706_MAINPLL_PLL0,
+                                               BCMA_CC_PMU5_MAINPLL_CPU);
+               case BCMA_CHIP_ID_BCM5356:
+@@ -313,10 +338,11 @@ u32 bcma_pmu_get_clockcpu(struct bcma_dr
+                       break;
+               }
+-              return bcma_pmu_clock(cc, pll, BCMA_CC_PMU5_MAINPLL_CPU);
++              return bcma_pmu_pll_clock(cc, pll, BCMA_CC_PMU5_MAINPLL_CPU);
+       }
+-      return bcma_pmu_get_clockcontrol(cc);
++      /* On old PMUs CPU has the same clock as the bus */
++      return bcma_pmu_get_bus_clock(cc);
+ }
+ static void bcma_pmu_spuravoid_pll_write(struct bcma_drv_cc *cc, u32 offset,
+@@ -362,7 +388,7 @@ void bcma_pmu_spuravoid_pllupdate(struct
+               tmp |= (bcm5357_bcm43236_ndiv[spuravoid]) << BCMA_CC_PMU1_PLL0_PC2_NDIV_INT_SHIFT;
+               bcma_cc_write32(cc, BCMA_CC_PLLCTL_DATA, tmp);
+-              tmp = 1 << 10;
++              tmp = BCMA_CC_PMU_CTL_PLL_UPD;
+               break;
+       case BCMA_CHIP_ID_BCM4331:
+@@ -383,7 +409,7 @@ void bcma_pmu_spuravoid_pllupdate(struct
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x03000a08);
+               }
+-              tmp = 1 << 10;
++              tmp = BCMA_CC_PMU_CTL_PLL_UPD;
+               break;
+       case BCMA_CHIP_ID_BCM43224:
+@@ -416,7 +442,7 @@ void bcma_pmu_spuravoid_pllupdate(struct
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL5,
+                                                    0x88888815);
+               }
+-              tmp = 1 << 10;
++              tmp = BCMA_CC_PMU_CTL_PLL_UPD;
+               break;
+       case BCMA_CHIP_ID_BCM4716:
+@@ -450,7 +476,7 @@ void bcma_pmu_spuravoid_pllupdate(struct
+                                                    0x88888815);
+               }
+-              tmp = 3 << 9;
++              tmp = BCMA_CC_PMU_CTL_PLL_UPD | BCMA_CC_PMU_CTL_NOILPONW;
+               break;
+       case BCMA_CHIP_ID_BCM43227:
+@@ -486,7 +512,7 @@ void bcma_pmu_spuravoid_pllupdate(struct
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL5,
+                                                    0x88888815);
+               }
+-              tmp = 1 << 10;
++              tmp = BCMA_CC_PMU_CTL_PLL_UPD;
+               break;
+       default:
+               bcma_err(bus, "Unknown spuravoidance settings for chip 0x%04X, not changing PLL\n",
 --- a/drivers/bcma/driver_chipcommon_sflash.c
 +++ b/drivers/bcma/driver_chipcommon_sflash.c
 @@ -5,15 +5,161 @@
 +      { "M25P40", 0x12, 0x10000, 8, },
 +
 +      { "M25P16", 0x14, 0x10000, 32, },
-+      { "M25P32", 0x14, 0x10000, 64, },
++      { "M25P32", 0x15, 0x10000, 64, },
 +      { "M25P64", 0x16, 0x10000, 128, },
 +      { "M25FL128", 0x17, 0x10000, 256, },
 +      { 0 },
 +
        return 0;
  }
+--- /dev/null
++++ b/drivers/bcma/driver_gpio.c
+@@ -0,0 +1,98 @@
++/*
++ * Broadcom specific AMBA
++ * GPIO driver
++ *
++ * Copyright 2011, Broadcom Corporation
++ * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
++ *
++ * Licensed under the GNU/GPL. See COPYING for details.
++ */
++
++#include <linux/gpio.h>
++#include <linux/export.h>
++#include <linux/bcma/bcma.h>
++
++#include "bcma_private.h"
++
++static inline struct bcma_drv_cc *bcma_gpio_get_cc(struct gpio_chip *chip)
++{
++      return container_of(chip, struct bcma_drv_cc, gpio);
++}
++
++static int bcma_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
++{
++      struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
++
++      return !!bcma_chipco_gpio_in(cc, 1 << gpio);
++}
++
++static void bcma_gpio_set_value(struct gpio_chip *chip, unsigned gpio,
++                              int value)
++{
++      struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
++
++      bcma_chipco_gpio_out(cc, 1 << gpio, value ? 1 << gpio : 0);
++}
++
++static int bcma_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
++{
++      struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
++
++      bcma_chipco_gpio_outen(cc, 1 << gpio, 0);
++      return 0;
++}
++
++static int bcma_gpio_direction_output(struct gpio_chip *chip, unsigned gpio,
++                                    int value)
++{
++      struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
++
++      bcma_chipco_gpio_outen(cc, 1 << gpio, 1 << gpio);
++      bcma_chipco_gpio_out(cc, 1 << gpio, value ? 1 << gpio : 0);
++      return 0;
++}
++
++static int bcma_gpio_request(struct gpio_chip *chip, unsigned gpio)
++{
++      struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
++
++      bcma_chipco_gpio_control(cc, 1 << gpio, 0);
++      /* clear pulldown */
++      bcma_chipco_gpio_pulldown(cc, 1 << gpio, 0);
++      /* Set pullup */
++      bcma_chipco_gpio_pullup(cc, 1 << gpio, 1 << gpio);
++
++      return 0;
++}
++
++static void bcma_gpio_free(struct gpio_chip *chip, unsigned gpio)
++{
++      struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
++
++      /* clear pullup */
++      bcma_chipco_gpio_pullup(cc, 1 << gpio, 0);
++}
++
++int bcma_gpio_init(struct bcma_drv_cc *cc)
++{
++      struct gpio_chip *chip = &cc->gpio;
++
++      chip->label             = "bcma_gpio";
++      chip->owner             = THIS_MODULE;
++      chip->request           = bcma_gpio_request;
++      chip->free              = bcma_gpio_free;
++      chip->get               = bcma_gpio_get_value;
++      chip->set               = bcma_gpio_set_value;
++      chip->direction_input   = bcma_gpio_direction_input;
++      chip->direction_output  = bcma_gpio_direction_output;
++      chip->ngpio             = 16;
++      /* There is just one SoC in one device and its GPIO addresses should be
++       * deterministic to address them more easily. The other buses could get
++       * a random base number. */
++      if (cc->core->bus->hosttype == BCMA_HOSTTYPE_SOC)
++              chip->base              = 0;
++      else
++              chip->base              = -1;
++
++      return gpiochip_add(chip);
++}
 --- a/drivers/bcma/driver_mips.c
 +++ b/drivers/bcma/driver_mips.c
-@@ -181,47 +181,66 @@ EXPORT_SYMBOL(bcma_cpu_clock);
+@@ -74,11 +74,16 @@ static u32 bcma_core_mips_irqflag(struct
+               return dev->core_index;
+       flag = bcma_aread32(dev, BCMA_MIPS_OOBSELOUTA30);
+-      return flag & 0x1F;
++      if (flag)
++              return flag & 0x1F;
++      else
++              return 0x3f;
+ }
+ /* Get the MIPS IRQ assignment for a specified device.
+  * If unassigned, 0 is returned.
++ * If disabled, 5 is returned.
++ * If not supported, 6 is returned.
+  */
+ unsigned int bcma_core_mips_irq(struct bcma_device *dev)
+ {
+@@ -87,13 +92,15 @@ unsigned int bcma_core_mips_irq(struct b
+       unsigned int irq;
+       irqflag = bcma_core_mips_irqflag(dev);
++      if (irqflag == 0x3f)
++              return 6;
+-      for (irq = 1; irq <= 4; irq++)
++      for (irq = 0; irq <= 4; irq++)
+               if (bcma_read32(mdev, BCMA_MIPS_MIPS74K_INTMASK(irq)) &
+                   (1 << irqflag))
+                       return irq;
+-      return 0;
++      return 5;
+ }
+ EXPORT_SYMBOL(bcma_core_mips_irq);
+@@ -114,8 +121,8 @@ static void bcma_core_mips_set_irq(struc
+               bcma_write32(mdev, BCMA_MIPS_MIPS74K_INTMASK(0),
+                           bcma_read32(mdev, BCMA_MIPS_MIPS74K_INTMASK(0)) &
+                           ~(1 << irqflag));
+-      else
+-              bcma_write32(mdev, BCMA_MIPS_MIPS74K_INTMASK(irq), 0);
++      else if (oldirq != 5)
++              bcma_write32(mdev, BCMA_MIPS_MIPS74K_INTMASK(oldirq), 0);
+       /* assign the new one */
+       if (irq == 0) {
+@@ -123,9 +130,9 @@ static void bcma_core_mips_set_irq(struc
+                           bcma_read32(mdev, BCMA_MIPS_MIPS74K_INTMASK(0)) |
+                           (1 << irqflag));
+       } else {
+-              u32 oldirqflag = bcma_read32(mdev,
+-                                           BCMA_MIPS_MIPS74K_INTMASK(irq));
+-              if (oldirqflag) {
++              u32 irqinitmask = bcma_read32(mdev,
++                                            BCMA_MIPS_MIPS74K_INTMASK(irq));
++              if (irqinitmask) {
+                       struct bcma_device *core;
+                       /* backplane irq line is in use, find out who uses
+@@ -133,7 +140,7 @@ static void bcma_core_mips_set_irq(struc
+                        */
+                       list_for_each_entry(core, &bus->cores, list) {
+                               if ((1 << bcma_core_mips_irqflag(core)) ==
+-                                  oldirqflag) {
++                                  irqinitmask) {
+                                       bcma_core_mips_set_irq(core, 0);
+                                       break;
+                               }
+@@ -143,15 +150,31 @@ static void bcma_core_mips_set_irq(struc
+                            1 << irqflag);
+       }
+-      bcma_info(bus, "set_irq: core 0x%04x, irq %d => %d\n",
+-                dev->id.id, oldirq + 2, irq + 2);
++      bcma_debug(bus, "set_irq: core 0x%04x, irq %d => %d\n",
++                 dev->id.id, oldirq <= 4 ? oldirq + 2 : 0, irq + 2);
++}
++
++static void bcma_core_mips_set_irq_name(struct bcma_bus *bus, unsigned int irq,
++                                      u16 coreid, u8 unit)
++{
++      struct bcma_device *core;
++
++      core = bcma_find_core_unit(bus, coreid, unit);
++      if (!core) {
++              bcma_warn(bus,
++                        "Can not find core (id: 0x%x, unit %i) for IRQ configuration.\n",
++                        coreid, unit);
++              return;
++      }
++
++      bcma_core_mips_set_irq(core, irq);
+ }
+ static void bcma_core_mips_print_irq(struct bcma_device *dev, unsigned int irq)
+ {
+       int i;
+       static const char *irq_name[] = {"2(S)", "3", "4", "5", "6", "D", "I"};
+-      printk(KERN_INFO KBUILD_MODNAME ": core 0x%04x, irq :", dev->id.id);
++      printk(KERN_DEBUG KBUILD_MODNAME ": core 0x%04x, irq :", dev->id.id);
+       for (i = 0; i <= 6; i++)
+               printk(" %s%s", irq_name[i], i == irq ? "*" : " ");
+       printk("\n");
+@@ -171,7 +194,7 @@ u32 bcma_cpu_clock(struct bcma_drv_mips 
+       struct bcma_bus *bus = mcore->core->bus;
+       if (bus->drv_cc.capabilities & BCMA_CC_CAP_PMU)
+-              return bcma_pmu_get_clockcpu(&bus->drv_cc);
++              return bcma_pmu_get_cpu_clock(&bus->drv_cc);
+       bcma_err(bus, "No PMU available, need this to get the cpu clock\n");
+       return 0;
+@@ -181,85 +204,109 @@ EXPORT_SYMBOL(bcma_cpu_clock);
  static void bcma_core_mips_flash_detect(struct bcma_drv_mips *mcore)
  {
        struct bcma_bus *bus = mcore->core->bus;
        struct bcma_device *core;
        bus = mcore->core->bus;
  
+-      bcma_info(bus, "Initializing MIPS core...\n");
 +      if (mcore->setup_done)
 +              return;
-+
-       bcma_info(bus, "Initializing MIPS core...\n");
  
 -      if (!mcore->setup_done)
 -              mcore->assigned_irqs = 1;
++      bcma_debug(bus, "Initializing MIPS core...\n");
+-      /* Assign IRQs to all cores on the bus */
+-      list_for_each_entry(core, &bus->cores, list) {
+-              int mips_irq;
+-              if (core->irq)
+-                      continue;
+-
+-              mips_irq = bcma_core_mips_irq(core);
+-              if (mips_irq > 4)
+-                      core->irq = 0;
+-              else
+-                      core->irq = mips_irq + 2;
+-              if (core->irq > 5)
+-                      continue;
+-              switch (core->id.id) {
+-              case BCMA_CORE_PCI:
+-              case BCMA_CORE_PCIE:
+-              case BCMA_CORE_ETHERNET:
+-              case BCMA_CORE_ETHERNET_GBIT:
+-              case BCMA_CORE_MAC_GBIT:
+-              case BCMA_CORE_80211:
+-              case BCMA_CORE_USB20_HOST:
+-                      /* These devices get their own IRQ line if available,
+-                       * the rest goes on IRQ0
+-                       */
+-                      if (mcore->assigned_irqs <= 4)
+-                              bcma_core_mips_set_irq(core,
+-                                                     mcore->assigned_irqs++);
+-                      break;
 +      bcma_core_mips_early_init(mcore);
 +
-+      mcore->assigned_irqs = 1;
-       /* Assign IRQs to all cores on the bus */
-       list_for_each_entry(core, &bus->cores, list) {
-@@ -256,10 +275,5 @@ void bcma_core_mips_init(struct bcma_drv
-       bcma_info(bus, "IRQ reconfiguration done\n");
++      switch (bus->chipinfo.id) {
++      case BCMA_CHIP_ID_BCM4716:
++      case BCMA_CHIP_ID_BCM4748:
++              bcma_core_mips_set_irq_name(bus, 1, BCMA_CORE_80211, 0);
++              bcma_core_mips_set_irq_name(bus, 2, BCMA_CORE_MAC_GBIT, 0);
++              bcma_core_mips_set_irq_name(bus, 3, BCMA_CORE_USB20_HOST, 0);
++              bcma_core_mips_set_irq_name(bus, 4, BCMA_CORE_PCIE, 0);
++              bcma_core_mips_set_irq_name(bus, 0, BCMA_CORE_CHIPCOMMON, 0);
++              bcma_core_mips_set_irq_name(bus, 0, BCMA_CORE_I2S, 0);
++              break;
++      case BCMA_CHIP_ID_BCM5356:
++      case BCMA_CHIP_ID_BCM47162:
++      case BCMA_CHIP_ID_BCM53572:
++              bcma_core_mips_set_irq_name(bus, 1, BCMA_CORE_80211, 0);
++              bcma_core_mips_set_irq_name(bus, 2, BCMA_CORE_MAC_GBIT, 0);
++              bcma_core_mips_set_irq_name(bus, 0, BCMA_CORE_CHIPCOMMON, 0);
++              break;
++      case BCMA_CHIP_ID_BCM5357:
++      case BCMA_CHIP_ID_BCM4749:
++              bcma_core_mips_set_irq_name(bus, 1, BCMA_CORE_80211, 0);
++              bcma_core_mips_set_irq_name(bus, 2, BCMA_CORE_MAC_GBIT, 0);
++              bcma_core_mips_set_irq_name(bus, 3, BCMA_CORE_USB20_HOST, 0);
++              bcma_core_mips_set_irq_name(bus, 0, BCMA_CORE_CHIPCOMMON, 0);
++              bcma_core_mips_set_irq_name(bus, 0, BCMA_CORE_I2S, 0);
++              break;
++      case BCMA_CHIP_ID_BCM4706:
++              bcma_core_mips_set_irq_name(bus, 1, BCMA_CORE_PCIE, 0);
++              bcma_core_mips_set_irq_name(bus, 2, BCMA_CORE_4706_MAC_GBIT,
++                                          0);
++              bcma_core_mips_set_irq_name(bus, 3, BCMA_CORE_PCIE, 1);
++              bcma_core_mips_set_irq_name(bus, 4, BCMA_CORE_USB20_HOST, 0);
++              bcma_core_mips_set_irq_name(bus, 0, BCMA_CORE_4706_CHIPCOMMON,
++                                          0);
++              break;
++      default:
++              list_for_each_entry(core, &bus->cores, list) {
++                      core->irq = bcma_core_mips_irq(core) + 2;
+               }
++              bcma_err(bus,
++                       "Unknown device (0x%x) found, can not configure IRQs\n",
++                       bus->chipinfo.id);
+       }
+-      bcma_info(bus, "IRQ reconfiguration done\n");
++      bcma_debug(bus, "IRQ reconfiguration done\n");
        bcma_core_mips_dump_irq(bus);
  
 -      if (mcore->setup_done)
        }
        pcicore_write32(pc, BCMA_CORE_PCI_MDIO_CONTROL, 0);
        return ret;
-@@ -132,7 +132,7 @@ static void bcma_pcie_mdio_write(struct
+@@ -132,7 +132,7 @@ static void bcma_pcie_mdio_write(struct 
                v = pcicore_read32(pc, BCMA_CORE_PCI_MDIO_CONTROL);
                if (v & BCMA_CORE_PCI_MDIOCTL_ACCESS_DONE)
                        break;
        register_pci_controller(&pc_host->pci_controller);
        return;
  }
+@@ -534,7 +538,7 @@ DECLARE_PCI_FIXUP_EARLY(PCI_ANY_ID, PCI_
+ static void bcma_core_pci_fixup_addresses(struct pci_dev *dev)
+ {
+       struct resource *res;
+-      int pos;
++      int pos, err;
+       if (dev->bus->ops->read != bcma_core_pci_hostmode_read_config) {
+               /* This is not a device on the PCI-core bridge. */
+@@ -547,8 +551,12 @@ static void bcma_core_pci_fixup_addresse
+       for (pos = 0; pos < 6; pos++) {
+               res = &dev->resource[pos];
+-              if (res->flags & (IORESOURCE_IO | IORESOURCE_MEM))
+-                      pci_assign_resource(dev, pos);
++              if (res->flags & (IORESOURCE_IO | IORESOURCE_MEM)) {
++                      err = pci_assign_resource(dev, pos);
++                      if (err)
++                              pr_err("PCI: Problem fixing up the addresses on %s\n",
++                                     pci_name(dev));
++              }
+       }
+ }
+ DECLARE_PCI_FIXUP_HEADER(PCI_ANY_ID, PCI_ANY_ID, bcma_core_pci_fixup_addresses);
 --- a/drivers/bcma/host_pci.c
 +++ b/drivers/bcma/host_pci.c
 @@ -77,8 +77,8 @@ static void bcma_host_pci_write32(struct
        .read8          = bcma_host_pci_read8,
        .read16         = bcma_host_pci_read16,
        .read32         = bcma_host_pci_read32,
+@@ -237,7 +238,7 @@ static void __devexit bcma_host_pci_remo
+       pci_set_drvdata(dev, NULL);
+ }
+-#ifdef CONFIG_PM
++#ifdef CONFIG_PM_SLEEP
+ static int bcma_host_pci_suspend(struct device *dev)
+ {
+       struct pci_dev *pdev = to_pci_dev(dev);
+@@ -260,11 +261,11 @@ static SIMPLE_DEV_PM_OPS(bcma_pm_ops, bc
+                        bcma_host_pci_resume);
+ #define BCMA_PM_OPS   (&bcma_pm_ops)
+-#else /* CONFIG_PM */
++#else /* CONFIG_PM_SLEEP */
+ #define BCMA_PM_OPS     NULL
+-#endif /* CONFIG_PM */
++#endif /* CONFIG_PM_SLEEP */
+ static DEFINE_PCI_DEVICE_TABLE(bcma_pci_bridge_tbl) = {
+       { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x0576) },
 @@ -272,6 +273,7 @@ static DEFINE_PCI_DEVICE_TABLE(bcma_pci_
        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4331) },
        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4353) },
  }
  EXPORT_SYMBOL_GPL(bcma_find_core);
  
-+static struct bcma_device *bcma_find_core_unit(struct bcma_bus *bus, u16 coreid,
-+                                             u8 unit)
++struct bcma_device *bcma_find_core_unit(struct bcma_bus *bus, u16 coreid,
++                                      u8 unit)
 +{
 +      struct bcma_device *core;
 +
  static void bcma_release_core_dev(struct device *dev)
  {
        struct bcma_device *core = container_of(dev, struct bcma_device, dev);
-@@ -136,6 +149,22 @@ static int bcma_register_cores(struct bc
+@@ -136,6 +149,33 @@ static int bcma_register_cores(struct bc
                dev_id++;
        }
  
 +                      bcma_err(bus, "Error registering NAND flash\n");
 +      }
 +#endif
++      err = bcma_gpio_init(&bus->drv_cc);
++      if (err == -ENOTSUPP)
++              bcma_debug(bus, "GPIO driver not activated\n");
++      else if (err)
++              bcma_err(bus, "Error registering GPIO driver: %i\n", err);
++
++      if (bus->hosttype == BCMA_HOSTTYPE_SOC) {
++              err = bcma_chipco_watchdog_register(&bus->drv_cc);
++              if (err)
++                      bcma_err(bus, "Error registering watchdog driver\n");
++      }
 +
        return 0;
  }
  
-@@ -166,6 +195,20 @@ int __devinit bcma_bus_register(struct b
+@@ -148,6 +188,8 @@ static void bcma_unregister_cores(struct
+               if (core->dev_registered)
+                       device_unregister(&core->dev);
+       }
++      if (bus->hosttype == BCMA_HOSTTYPE_SOC)
++              platform_device_unregister(bus->drv_cc.watchdog);
+ }
+ int __devinit bcma_bus_register(struct bcma_bus *bus)
+@@ -166,6 +208,20 @@ int __devinit bcma_bus_register(struct b
                return -1;
        }
  
        /* Init CC core */
        core = bcma_find_core(bus, bcma_cc_core_id(bus));
        if (core) {
-@@ -181,10 +224,17 @@ int __devinit bcma_bus_register(struct b
+@@ -181,10 +237,17 @@ int __devinit bcma_bus_register(struct b
        }
  
        /* Init PCIE core */
        }
  
        /* Init GBIT MAC COMMON core */
-@@ -194,13 +244,6 @@ int __devinit bcma_bus_register(struct b
+@@ -194,13 +257,6 @@ int __devinit bcma_bus_register(struct b
                bcma_core_gmac_cmn_init(&bus->drv_gmac_cmn);
        }
  
        /* Register found cores */
        bcma_register_cores(bus);
  
-@@ -211,7 +254,17 @@ int __devinit bcma_bus_register(struct b
+@@ -211,7 +267,17 @@ int __devinit bcma_bus_register(struct b
  
  void bcma_bus_unregister(struct bcma_bus *bus)
  {
  }
  
  int __init bcma_bus_early_register(struct bcma_bus *bus,
-@@ -248,18 +301,18 @@ int __init bcma_bus_early_register(struc
+@@ -248,18 +314,18 @@ int __init bcma_bus_early_register(struc
                return -1;
        }
  
  
  struct bcma_device;
  struct bcma_bus;
-@@ -251,7 +251,7 @@ struct bcma_bus {
+@@ -157,6 +157,7 @@ struct bcma_host_ops {
+ /* Chip IDs of SoCs */
+ #define BCMA_CHIP_ID_BCM4706  0x5300
++#define  BCMA_PKG_ID_BCM4706L 1
+ #define BCMA_CHIP_ID_BCM4716  0x4716
+ #define  BCMA_PKG_ID_BCM4716  8
+ #define  BCMA_PKG_ID_BCM4717  9
+@@ -166,7 +167,11 @@ struct bcma_host_ops {
+ #define BCMA_CHIP_ID_BCM4749  0x4749
+ #define BCMA_CHIP_ID_BCM5356  0x5356
+ #define BCMA_CHIP_ID_BCM5357  0x5357
++#define  BCMA_PKG_ID_BCM5358  9
++#define  BCMA_PKG_ID_BCM47186 10
++#define  BCMA_PKG_ID_BCM5357  11
+ #define BCMA_CHIP_ID_BCM53572 53572
++#define  BCMA_PKG_ID_BCM47188 9
+ struct bcma_device {
+       struct bcma_bus *bus;
+@@ -251,7 +256,7 @@ struct bcma_bus {
        u8 num;
  
        struct bcma_drv_cc drv_cc;
        struct bcma_drv_mips drv_mips;
        struct bcma_drv_gmac_cmn drv_gmac_cmn;
  
+@@ -345,6 +350,7 @@ extern void bcma_core_set_clockmode(stru
+                                   enum bcma_clkmode clkmode);
+ extern void bcma_core_pll_ctl(struct bcma_device *core, u32 req, u32 status,
+                             bool on);
++extern u32 bcma_chipco_pll_read(struct bcma_drv_cc *cc, u32 offset);
+ #define BCMA_DMA_TRANSLATION_MASK     0xC0000000
+ #define  BCMA_DMA_TRANSLATION_NONE    0x00000000
+ #define  BCMA_DMA_TRANSLATION_DMA32_CMT       0x40000000 /* Client Mode Translation for 32-bit DMA */
 --- a/include/linux/bcma/bcma_driver_chipcommon.h
 +++ b/include/linux/bcma/bcma_driver_chipcommon.h
-@@ -100,6 +100,7 @@
+@@ -1,6 +1,9 @@
+ #ifndef LINUX_BCMA_DRIVER_CC_H_
+ #define LINUX_BCMA_DRIVER_CC_H_
++#include <linux/platform_device.h>
++#include <linux/gpio.h>
++
+ /** ChipCommon core registers. **/
+ #define BCMA_CC_ID                    0x0000
+ #define  BCMA_CC_ID_ID                        0x0000FFFF
+@@ -100,6 +103,8 @@
  #define  BCMA_CC_CHIPST_4706_SFLASH_TYPE      BIT(2) /* 0: 8b-p/ST-s flash, 1: 16b-p/Atmal-s flash */
  #define  BCMA_CC_CHIPST_4706_MIPS_BENDIAN     BIT(3) /* 0: little, 1: big endian */
  #define  BCMA_CC_CHIPST_4706_PCIE1_DISABLE    BIT(5) /* PCIE1 enable strap pin */
 +#define  BCMA_CC_CHIPST_5357_NAND_BOOT                BIT(4) /* NAND boot, valid for CC rev 38 and/or BCM5357 */
++#define  BCMA_CC_CHIPST_4360_XTAL_40MZ                0x00000001
  #define BCMA_CC_JCMD                  0x0030          /* Rev >= 10 only */
  #define  BCMA_CC_JCMD_START           0x80000000
  #define  BCMA_CC_JCMD_BUSY            0x80000000
-@@ -266,6 +267,29 @@
+@@ -266,6 +271,29 @@
  #define  BCMA_CC_SROM_CONTROL_SIZE_16K        0x00000004
  #define  BCMA_CC_SROM_CONTROL_SIZE_SHIFT      1
  #define  BCMA_CC_SROM_CONTROL_PRESENT 0x00000001
  /* 0x1E0 is defined as shared BCMA_CLKCTLST */
  #define BCMA_CC_HW_WORKAROUND         0x01E4 /* Hardware workaround (rev >= 20) */
  #define BCMA_CC_UART0_DATA            0x0300
-@@ -325,6 +349,60 @@
+@@ -325,6 +353,60 @@
  #define BCMA_CC_PLLCTL_ADDR           0x0660
  #define BCMA_CC_PLLCTL_DATA           0x0664
  #define BCMA_CC_SPROM                 0x0800 /* SPROM beginning */
  
  /* Divider allocation in 4716/47162/5356 */
  #define BCMA_CC_PMU5_MAINPLL_CPU      1
-@@ -415,6 +493,13 @@
+@@ -415,6 +497,13 @@
  /* 4313 Chip specific ChipControl register bits */
  #define BCMA_CCTRL_4313_12MA_LED_DRIVE                0x00000007      /* 12 mA drive strengh for later 4313 */
  
  /* Data for the PMU, if available.
   * Check availability with ((struct bcma_chipcommon)->capabilities & BCMA_CC_CAP_PMU)
   */
-@@ -425,11 +510,35 @@ struct bcma_chipcommon_pmu {
+@@ -425,11 +514,35 @@ struct bcma_chipcommon_pmu {
  
  #ifdef CONFIG_BCMA_DRIVER_MIPS
  struct bcma_pflash {
  struct bcma_serial_port {
        void *regs;
        unsigned long clockspeed;
-@@ -445,11 +554,18 @@ struct bcma_drv_cc {
+@@ -445,15 +558,30 @@ struct bcma_drv_cc {
        u32 capabilities;
        u32 capabilities_ext;
        u8 setup_done:1;
  
        int nr_serial_ports;
        struct bcma_serial_port serial_ports[4];
-@@ -470,6 +586,7 @@ struct bcma_drv_cc {
+ #endif /* CONFIG_BCMA_DRIVER_MIPS */
++      u32 ticks_per_ms;
++      struct platform_device *watchdog;
++
++      /* Lock for GPIO register access. */
++      spinlock_t gpio_lock;
++#ifdef CONFIG_BCMA_DRIVER_GPIO
++      struct gpio_chip gpio;
++#endif
+ };
+ /* Register access */
+@@ -470,14 +598,16 @@ struct bcma_drv_cc {
        bcma_cc_write32(cc, offset, (bcma_cc_read32(cc, offset) & (mask)) | (set))
  
  extern void bcma_core_chipcommon_init(struct bcma_drv_cc *cc);
  
  extern void bcma_chipco_suspend(struct bcma_drv_cc *cc);
  extern void bcma_chipco_resume(struct bcma_drv_cc *cc);
-@@ -493,6 +610,7 @@ u32 bcma_chipco_gpio_polarity(struct bcm
+ void bcma_chipco_bcm4331_ext_pa_lines_ctl(struct bcma_drv_cc *cc, bool enable);
+-extern void bcma_chipco_watchdog_timer_set(struct bcma_drv_cc *cc,
+-                                        u32 ticks);
++extern u32 bcma_chipco_watchdog_timer_set(struct bcma_drv_cc *cc, u32 ticks);
++
++extern u32 bcma_chipco_get_alp_clock(struct bcma_drv_cc *cc);
+ void bcma_chipco_irq_mask(struct bcma_drv_cc *cc, u32 mask, u32 value);
+@@ -490,9 +620,12 @@ u32 bcma_chipco_gpio_outen(struct bcma_d
+ u32 bcma_chipco_gpio_control(struct bcma_drv_cc *cc, u32 mask, u32 value);
+ u32 bcma_chipco_gpio_intmask(struct bcma_drv_cc *cc, u32 mask, u32 value);
+ u32 bcma_chipco_gpio_polarity(struct bcma_drv_cc *cc, u32 mask, u32 value);
++u32 bcma_chipco_gpio_pullup(struct bcma_drv_cc *cc, u32 mask, u32 value);
++u32 bcma_chipco_gpio_pulldown(struct bcma_drv_cc *cc, u32 mask, u32 value);
  
  /* PMU support */
  extern void bcma_pmu_init(struct bcma_drv_cc *cc);
                                  u32 value);
 --- a/include/linux/bcma/bcma_driver_mips.h
 +++ b/include/linux/bcma/bcma_driver_mips.h
-@@ -35,13 +35,16 @@ struct bcma_device;
+@@ -35,13 +35,15 @@ struct bcma_device;
  struct bcma_drv_mips {
        struct bcma_device *core;
        u8 setup_done:1;
+-      unsigned int assigned_irqs;
 +      u8 early_setup_done:1;
-       unsigned int assigned_irqs;
  };
  
  #ifdef CONFIG_BCMA_DRIVER_MIPS
 +#define BCMA_SOC_FLASH2_SZ            0x02000000      /* Size of Flash Region 2 */
 +
  #endif /* LINUX_BCMA_REGS_H_ */
+--- a/drivers/net/wireless/b43/main.c
++++ b/drivers/net/wireless/b43/main.c
+@@ -4622,7 +4622,7 @@ static int b43_wireless_core_init(struct
+       switch (dev->dev->bus_type) {
+ #ifdef CONFIG_B43_BCMA
+       case B43_BUS_BCMA:
+-              bcma_core_pci_irq_ctl(&dev->dev->bdev->bus->drv_pci,
++              bcma_core_pci_irq_ctl(&dev->dev->bdev->bus->drv_pci[0],
+                                     dev->dev->bdev, true);
+               break;
+ #endif
+--- a/drivers/net/wireless/brcm80211/brcmsmac/aiutils.c
++++ b/drivers/net/wireless/brcm80211/brcmsmac/aiutils.c
+@@ -695,7 +695,7 @@ void ai_pci_up(struct si_pub *sih)
+       sii = container_of(sih, struct si_info, pub);
+       if (sii->icbus->hosttype == BCMA_HOSTTYPE_PCI)
+-              bcma_core_pci_extend_L1timer(&sii->icbus->drv_pci, true);
++              bcma_core_pci_extend_L1timer(&sii->icbus->drv_pci[0], true);
+ }
+ /* Unconfigure and/or apply various WARs when going down */
+@@ -706,7 +706,7 @@ void ai_pci_down(struct si_pub *sih)
+       sii = container_of(sih, struct si_info, pub);
+       if (sii->icbus->hosttype == BCMA_HOSTTYPE_PCI)
+-              bcma_core_pci_extend_L1timer(&sii->icbus->drv_pci, false);
++              bcma_core_pci_extend_L1timer(&sii->icbus->drv_pci[0], false);
+ }
+ /* Enable BT-COEX & Ex-PA for 4313 */
+--- a/drivers/net/wireless/brcm80211/brcmsmac/main.c
++++ b/drivers/net/wireless/brcm80211/brcmsmac/main.c
+@@ -5077,7 +5077,7 @@ static int brcms_b_up_prep(struct brcms_
+        * Configure pci/pcmcia here instead of in brcms_c_attach()
+        * to allow mfg hotswap:  down, hotswap (chip power cycle), up.
+        */
+-      bcma_core_pci_irq_ctl(&wlc_hw->d11core->bus->drv_pci, wlc_hw->d11core,
++      bcma_core_pci_irq_ctl(&wlc_hw->d11core->bus->drv_pci[0], wlc_hw->d11core,
+                             true);
+       /*