kernel: update bcma to the version from wireless-testing master-2014-09-04 tag
[openwrt.git] / target / linux / generic / patches-3.10 / 025-bcma_backport.patch
index c3f7ffb..ab4b2ce 100644 (file)
        help
          Driver to provide access to the GPIO pins of the bcma bus.
  
+--- a/drivers/bcma/Makefile
++++ b/drivers/bcma/Makefile
+@@ -3,6 +3,7 @@ bcma-y                                 += driver_chipcommon.o driver
+ bcma-$(CONFIG_BCMA_SFLASH)            += driver_chipcommon_sflash.o
+ bcma-$(CONFIG_BCMA_NFLASH)            += driver_chipcommon_nflash.o
+ bcma-y                                        += driver_pci.o
++bcma-y                                        += driver_pcie2.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
 --- a/drivers/bcma/bcma_private.h
 +++ b/drivers/bcma/bcma_private.h
 @@ -22,6 +22,8 @@
        bcma_pmu_resources_init(cc);
        bcma_pmu_workarounds(cc);
  }
+@@ -480,6 +603,8 @@ void bcma_pmu_spuravoid_pllupdate(struct
+               tmp = BCMA_CC_PMU_CTL_PLL_UPD | BCMA_CC_PMU_CTL_NOILPONW;
+               break;
++      case BCMA_CHIP_ID_BCM43131:
++      case BCMA_CHIP_ID_BCM43217:
+       case BCMA_CHIP_ID_BCM43227:
+       case BCMA_CHIP_ID_BCM43228:
+       case BCMA_CHIP_ID_BCM43428:
 --- a/drivers/bcma/driver_chipcommon_sflash.c
 +++ b/drivers/bcma/driver_chipcommon_sflash.c
 @@ -30,7 +30,7 @@ struct bcma_sflash_tbl_e {
  
        chip->label             = "bcma_gpio";
        chip->owner             = THIS_MODULE;
-@@ -95,8 +215,17 @@ int bcma_gpio_init(struct bcma_drv_cc *c
+@@ -95,8 +215,18 @@ int bcma_gpio_init(struct bcma_drv_cc *c
        chip->set               = bcma_gpio_set_value;
        chip->direction_input   = bcma_gpio_direction_input;
        chip->direction_output  = bcma_gpio_direction_output;
 +#endif
 +      switch (cc->core->bus->chipinfo.id) {
 +      case BCMA_CHIP_ID_BCM5357:
++      case BCMA_CHIP_ID_BCM53572:
 +              chip->ngpio     = 32;
 +              break;
 +      default:
        /* 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. */
-@@ -105,10 +234,21 @@ int bcma_gpio_init(struct bcma_drv_cc *c
+@@ -105,10 +235,21 @@ int bcma_gpio_init(struct bcma_drv_cc *c
        else
                chip->base              = -1;
  
        return 0;
  }
  EXPORT_SYMBOL(bcma_core_pci_plat_dev_init);
+--- /dev/null
++++ b/drivers/bcma/driver_pcie2.c
+@@ -0,0 +1,175 @@
++/*
++ * Broadcom specific AMBA
++ * PCIe Gen 2 Core
++ *
++ * Copyright 2014, Broadcom Corporation
++ * Copyright 2014, Rafał Miłecki <zajec5@gmail.com>
++ *
++ * Licensed under the GNU/GPL. See COPYING for details.
++ */
++
++#include "bcma_private.h"
++#include <linux/bcma/bcma.h>
++
++/**************************************************
++ * R/W ops.
++ **************************************************/
++
++#if 0
++static u32 bcma_core_pcie2_cfg_read(struct bcma_drv_pcie2 *pcie2, u32 addr)
++{
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR, addr);
++      pcie2_read32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR);
++      return pcie2_read32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA);
++}
++#endif
++
++static void bcma_core_pcie2_cfg_write(struct bcma_drv_pcie2 *pcie2, u32 addr,
++                                    u32 val)
++{
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR, addr);
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA, val);
++}
++
++/**************************************************
++ * Init.
++ **************************************************/
++
++static u32 bcma_core_pcie2_war_delay_perst_enab(struct bcma_drv_pcie2 *pcie2,
++                                              bool enable)
++{
++      u32 val;
++
++      /* restore back to default */
++      val = pcie2_read32(pcie2, BCMA_CORE_PCIE2_CLK_CONTROL);
++      val |= PCIE2_CLKC_DLYPERST;
++      val &= ~PCIE2_CLKC_DISSPROMLD;
++      if (enable) {
++              val &= ~PCIE2_CLKC_DLYPERST;
++              val |= PCIE2_CLKC_DISSPROMLD;
++      }
++      pcie2_write32(pcie2, (BCMA_CORE_PCIE2_CLK_CONTROL), val);
++      /* flush */
++      return pcie2_read32(pcie2, BCMA_CORE_PCIE2_CLK_CONTROL);
++}
++
++static void bcma_core_pcie2_set_ltr_vals(struct bcma_drv_pcie2 *pcie2)
++{
++      /* LTR0 */
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR, 0x844);
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA, 0x883c883c);
++      /* LTR1 */
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR, 0x848);
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA, 0x88648864);
++      /* LTR2 */
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR, 0x84C);
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA, 0x90039003);
++}
++
++static void bcma_core_pcie2_hw_ltr_war(struct bcma_drv_pcie2 *pcie2)
++{
++      u8 core_rev = pcie2->core->id.rev;
++      u32 devstsctr2;
++
++      if (core_rev < 2 || core_rev == 10 || core_rev > 13)
++              return;
++
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR,
++                    PCIE2_CAP_DEVSTSCTRL2_OFFSET);
++      devstsctr2 = pcie2_read32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA);
++      if (devstsctr2 & PCIE2_CAP_DEVSTSCTRL2_LTRENAB) {
++              /* force the right LTR values */
++              bcma_core_pcie2_set_ltr_vals(pcie2);
++
++              /* TODO:
++              si_core_wrapperreg(pcie2, 3, 0x60, 0x8080, 0); */
++
++              /* enable the LTR */
++              devstsctr2 |= PCIE2_CAP_DEVSTSCTRL2_LTRENAB;
++              pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR,
++                            PCIE2_CAP_DEVSTSCTRL2_OFFSET);
++              pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA, devstsctr2);
++
++              /* set the LTR state to be active */
++              pcie2_write32(pcie2, BCMA_CORE_PCIE2_LTR_STATE,
++                            PCIE2_LTR_ACTIVE);
++              usleep_range(1000, 2000);
++
++              /* set the LTR state to be sleep */
++              pcie2_write32(pcie2, BCMA_CORE_PCIE2_LTR_STATE,
++                            PCIE2_LTR_SLEEP);
++              usleep_range(1000, 2000);
++      }
++}
++
++static void pciedev_crwlpciegen2(struct bcma_drv_pcie2 *pcie2)
++{
++      u8 core_rev = pcie2->core->id.rev;
++      bool pciewar160, pciewar162;
++
++      pciewar160 = core_rev == 7 || core_rev == 9 || core_rev == 11;
++      pciewar162 = core_rev == 5 || core_rev == 7 || core_rev == 8 ||
++                   core_rev == 9 || core_rev == 11;
++
++      if (!pciewar160 && !pciewar162)
++              return;
++
++/* TODO */
++#if 0
++      pcie2_set32(pcie2, BCMA_CORE_PCIE2_CLK_CONTROL,
++                  PCIE_DISABLE_L1CLK_GATING);
++#if 0
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR,
++                    PCIEGEN2_COE_PVT_TL_CTRL_0);
++      pcie2_mask32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA,
++                   ~(1 << COE_PVT_TL_CTRL_0_PM_DIS_L1_REENTRY_BIT));
++#endif
++#endif
++}
++
++static void pciedev_crwlpciegen2_180(struct bcma_drv_pcie2 *pcie2)
++{
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR, PCIE2_PMCR_REFUP);
++      pcie2_set32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA, 0x1f);
++}
++
++static void pciedev_crwlpciegen2_182(struct bcma_drv_pcie2 *pcie2)
++{
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR, PCIE2_SBMBX);
++      pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA, 1 << 0);
++}
++
++static void pciedev_reg_pm_clk_period(struct bcma_drv_pcie2 *pcie2)
++{
++      struct bcma_drv_cc *drv_cc = &pcie2->core->bus->drv_cc;
++      u8 core_rev = pcie2->core->id.rev;
++      u32 alp_khz, pm_value;
++
++      if (core_rev <= 13) {
++              alp_khz = bcma_pmu_get_alp_clock(drv_cc) / 1000;
++              pm_value = (1000000 * 2) / alp_khz;
++              pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDADDR,
++                            PCIE2_PVT_REG_PM_CLK_PERIOD);
++              pcie2_write32(pcie2, BCMA_CORE_PCIE2_CONFIGINDDATA, pm_value);
++      }
++}
++
++void bcma_core_pcie2_init(struct bcma_drv_pcie2 *pcie2)
++{
++      struct bcma_chipinfo *ci = &pcie2->core->bus->chipinfo;
++      u32 tmp;
++
++      tmp = pcie2_read32(pcie2, BCMA_CORE_PCIE2_SPROM(54));
++      if ((tmp & 0xe) >> 1 == 2)
++              bcma_core_pcie2_cfg_write(pcie2, 0x4e0, 0x17);
++
++      /* TODO: Do we need pcie_reqsize? */
++
++      if (ci->id == BCMA_CHIP_ID_BCM4360 && ci->rev > 3)
++              bcma_core_pcie2_war_delay_perst_enab(pcie2, true);
++      bcma_core_pcie2_hw_ltr_war(pcie2);
++      pciedev_crwlpciegen2(pcie2);
++      pciedev_reg_pm_clk_period(pcie2);
++      pciedev_crwlpciegen2_180(pcie2);
++      pciedev_crwlpciegen2_182(pcie2);
++}
 --- a/drivers/bcma/host_pci.c
 +++ b/drivers/bcma/host_pci.c
 @@ -188,8 +188,11 @@ static int bcma_host_pci_probe(struct pc
  }
  
  #ifdef CONFIG_PM_SLEEP
-@@ -267,14 +269,16 @@ static SIMPLE_DEV_PM_OPS(bcma_pm_ops, bc
+@@ -267,14 +269,18 @@ static SIMPLE_DEV_PM_OPS(bcma_pm_ops, bc
  
  #endif /* CONFIG_PM_SLEEP */
  
        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4358) },
        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4359) },
 +      { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4365) },
++      { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x43a9) },
++      { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x43aa) },
        { PCI_DEVICE(PCI_VENDOR_ID_BROADCOM, 0x4727) },
        { 0, },
  };
  }
  
  static void bcma_release_core_dev(struct device *dev)
-@@ -148,6 +156,7 @@ static int bcma_register_cores(struct bc
+@@ -115,6 +123,7 @@ static int bcma_register_cores(struct bc
+               case BCMA_CORE_CHIPCOMMON:
+               case BCMA_CORE_PCI:
+               case BCMA_CORE_PCIE:
++              case BCMA_CORE_PCIE2:
+               case BCMA_CORE_MIPS_74K:
+               case BCMA_CORE_4706_MAC_GBIT_COMMON:
+                       continue;
+@@ -148,6 +157,7 @@ static int bcma_register_cores(struct bc
                        bcma_err(bus,
                                 "Could not register dev for core 0x%03X\n",
                                 core->id.id);
                        continue;
                }
                core->dev_registered = true;
-@@ -218,7 +227,7 @@ int bcma_bus_register(struct bcma_bus *b
+@@ -218,7 +228,7 @@ int bcma_bus_register(struct bcma_bus *b
        err = bcma_bus_scan(bus);
        if (err) {
                bcma_err(bus, "Failed to scan: %d\n", err);
        }
  
        /* Early init CC core */
+@@ -263,6 +273,13 @@ int bcma_bus_register(struct bcma_bus *b
+               bcma_core_pci_init(&bus->drv_pci[1]);
+       }
++      /* Init PCIe Gen 2 core */
++      core = bcma_find_core_unit(bus, BCMA_CORE_PCIE2, 0);
++      if (core) {
++              bus->drv_pcie2.core = core;
++              bcma_core_pcie2_init(&bus->drv_pcie2);
++      }
++
+       /* Init GBIT MAC COMMON core */
+       core = bcma_find_core(bus, BCMA_CORE_4706_MAC_GBIT_COMMON);
+       if (core) {
 --- a/drivers/bcma/scan.c
 +++ b/drivers/bcma/scan.c
 @@ -32,6 +32,18 @@ static const struct bcma_device_id_name
        { BCMA_CORE_4706_CHIPCOMMON, "BCM4706 ChipCommon" },
        { BCMA_CORE_4706_SOC_RAM, "BCM4706 SOC RAM" },
        { BCMA_CORE_4706_MAC_GBIT, "BCM4706 GBit MAC" },
-+      { BCMA_CORE_PCIEG2, "PCIe Gen 2" },
-+      { BCMA_CORE_DMA, "DMA" },
-+      { BCMA_CORE_SDIO3, "SDIO3" },
-+      { BCMA_CORE_USB20, "USB 2.0" },
-+      { BCMA_CORE_USB30, "USB 3.0" },
-+      { BCMA_CORE_A9JTAG, "ARM Cortex A9 JTAG" },
-+      { BCMA_CORE_DDR23, "Denali DDR2/DDR3 memory controller" },
-+      { BCMA_CORE_ROM, "ROM" },
-+      { BCMA_CORE_NAND, "NAND flash controller" },
-+      { BCMA_CORE_QSPI, "SPI flash controller" },
-+      { BCMA_CORE_CHIPCOMMON_B, "Chipcommon B" },
++      { BCMA_CORE_NS_PCIEG2, "PCIe Gen 2" },
++      { BCMA_CORE_NS_DMA, "DMA" },
++      { BCMA_CORE_NS_SDIO3, "SDIO3" },
++      { BCMA_CORE_NS_USB20, "USB 2.0" },
++      { BCMA_CORE_NS_USB30, "USB 3.0" },
++      { BCMA_CORE_NS_A9JTAG, "ARM Cortex A9 JTAG" },
++      { BCMA_CORE_NS_DDR23, "Denali DDR2/DDR3 memory controller" },
++      { BCMA_CORE_NS_ROM, "ROM" },
++      { BCMA_CORE_NS_NAND, "NAND flash controller" },
++      { BCMA_CORE_NS_QSPI, "SPI flash controller" },
++      { BCMA_CORE_NS_CHIPCOMMON_B, "Chipcommon B" },
 +      { BCMA_CORE_ARMCA9, "ARM Cortex A9 core (ihost)" },
        { BCMA_CORE_AMEMC, "AMEMC (DDR)" },
        { BCMA_CORE_ALTA, "ALTA (I2S)" },
                                /* no more entries for port _i_ */
                                /* pr_debug("erom: master wrapper %d "
                                 * has %d descriptors\n", i, j); */
+@@ -407,10 +421,13 @@ static int bcma_get_next_core(struct bcm
+               core->io_addr = ioremap_nocache(core->addr, BCMA_CORE_SIZE);
+               if (!core->io_addr)
+                       return -ENOMEM;
+-              core->io_wrap = ioremap_nocache(core->wrap, BCMA_CORE_SIZE);
+-              if (!core->io_wrap) {
+-                      iounmap(core->io_addr);
+-                      return -ENOMEM;
++              if (core->wrap) {
++                      core->io_wrap = ioremap_nocache(core->wrap,
++                                                      BCMA_CORE_SIZE);
++                      if (!core->io_wrap) {
++                              iounmap(core->io_addr);
++                              return -ENOMEM;
++                      }
+               }
+       }
+       return 0;
 --- a/drivers/bcma/sprom.c
 +++ b/drivers/bcma/sprom.c
 @@ -72,12 +72,12 @@ fail:
        return 0;
  }
  
-@@ -208,9 +212,6 @@ static void bcma_sprom_extract_r8(struct
+@@ -197,6 +201,23 @@ static int bcma_sprom_valid(const u16 *s
+               SPEX(_field[7], _offset + 14, _mask, _shift);   \
+       } while (0)
++static s8 sprom_extract_antgain(const u16 *in, u16 offset, u16 mask, u16 shift)
++{
++      u16 v;
++      u8 gain;
++
++      v = in[SPOFF(offset)];
++      gain = (v & mask) >> shift;
++      if (gain == 0xFF) {
++              gain = 8; /* If unset use 2dBm */
++      } else {
++              /* Q5.2 Fractional part is stored in 0xC0 */
++              gain = ((gain & 0xC0) >> 6) | ((gain & 0x3F) << 2);
++      }
++
++      return (s8)gain;
++}
++
+ static void bcma_sprom_extract_r8(struct bcma_bus *bus, const u16 *sprom)
+ {
+       u16 v, o;
+@@ -208,9 +229,6 @@ static void bcma_sprom_extract_r8(struct
        BUILD_BUG_ON(ARRAY_SIZE(pwr_info_offset) !=
                        ARRAY_SIZE(bus->sprom.core_pwr_info));
  
        for (i = 0; i < 3; i++) {
                v = sprom[SPOFF(SSB_SPROM8_IL0MAC) + i];
                *(((__be16 *)bus->sprom.il0mac) + i) = cpu_to_be16(v);
-@@ -502,7 +503,7 @@ static bool bcma_sprom_onchip_available(
+@@ -380,14 +398,22 @@ static void bcma_sprom_extract_r8(struct
+       SPEX32(ofdm5ghpo, SSB_SPROM8_OFDM5GHPO, ~0, 0);
+       /* Extract the antenna gain values. */
+-      SPEX(antenna_gain.a0, SSB_SPROM8_AGAIN01,
+-           SSB_SPROM8_AGAIN0, SSB_SPROM8_AGAIN0_SHIFT);
+-      SPEX(antenna_gain.a1, SSB_SPROM8_AGAIN01,
+-           SSB_SPROM8_AGAIN1, SSB_SPROM8_AGAIN1_SHIFT);
+-      SPEX(antenna_gain.a2, SSB_SPROM8_AGAIN23,
+-           SSB_SPROM8_AGAIN2, SSB_SPROM8_AGAIN2_SHIFT);
+-      SPEX(antenna_gain.a3, SSB_SPROM8_AGAIN23,
+-           SSB_SPROM8_AGAIN3, SSB_SPROM8_AGAIN3_SHIFT);
++      bus->sprom.antenna_gain.a0 = sprom_extract_antgain(sprom,
++                                                         SSB_SPROM8_AGAIN01,
++                                                         SSB_SPROM8_AGAIN0,
++                                                         SSB_SPROM8_AGAIN0_SHIFT);
++      bus->sprom.antenna_gain.a1 = sprom_extract_antgain(sprom,
++                                                         SSB_SPROM8_AGAIN01,
++                                                         SSB_SPROM8_AGAIN1,
++                                                         SSB_SPROM8_AGAIN1_SHIFT);
++      bus->sprom.antenna_gain.a2 = sprom_extract_antgain(sprom,
++                                                         SSB_SPROM8_AGAIN23,
++                                                         SSB_SPROM8_AGAIN2,
++                                                         SSB_SPROM8_AGAIN2_SHIFT);
++      bus->sprom.antenna_gain.a3 = sprom_extract_antgain(sprom,
++                                                         SSB_SPROM8_AGAIN23,
++                                                         SSB_SPROM8_AGAIN3,
++                                                         SSB_SPROM8_AGAIN3_SHIFT);
+       SPEX(leddc_on_time, SSB_SPROM8_LEDDC, SSB_SPROM8_LEDDC_ON,
+            SSB_SPROM8_LEDDC_ON_SHIFT);
+@@ -502,12 +528,14 @@ static bool bcma_sprom_onchip_available(
        case BCMA_CHIP_ID_BCM4331:
                present = chip_status & BCMA_CC_CHIPST_4331_OTP_PRESENT;
                break;
        case BCMA_CHIP_ID_BCM43224:
        case BCMA_CHIP_ID_BCM43225:
                /* for these chips OTP is always available */
-@@ -550,7 +551,9 @@ int bcma_sprom_get(struct bcma_bus *bus)
+               present = true;
+               break;
++      case BCMA_CHIP_ID_BCM43131:
++      case BCMA_CHIP_ID_BCM43217:
+       case BCMA_CHIP_ID_BCM43227:
+       case BCMA_CHIP_ID_BCM43228:
+       case BCMA_CHIP_ID_BCM43428:
+@@ -550,7 +578,9 @@ int bcma_sprom_get(struct bcma_bus *bus)
  {
        u16 offset = BCMA_CC_SPROM;
        u16 *sprom;
  
        if (!bus->drv_cc.core)
                return -EOPNOTSUPP;
-@@ -579,32 +582,37 @@ int bcma_sprom_get(struct bcma_bus *bus)
+@@ -579,32 +609,37 @@ int bcma_sprom_get(struct bcma_bus *bus)
                }
        }
  
  }
 --- a/include/linux/bcma/bcma.h
 +++ b/include/linux/bcma/bcma.h
-@@ -72,7 +72,19 @@ struct bcma_host_ops {
+@@ -6,6 +6,7 @@
+ #include <linux/bcma/bcma_driver_chipcommon.h>
+ #include <linux/bcma/bcma_driver_pci.h>
++#include <linux/bcma/bcma_driver_pcie2.h>
+ #include <linux/bcma/bcma_driver_mips.h>
+ #include <linux/bcma/bcma_driver_gmac_cmn.h>
+ #include <linux/ssb/ssb.h> /* SPROM sharing */
+@@ -72,7 +73,19 @@ struct bcma_host_ops {
  /* Core-ID values. */
  #define BCMA_CORE_OOB_ROUTER          0x367   /* Out of band */
  #define BCMA_CORE_4706_CHIPCOMMON     0x500
-+#define BCMA_CORE_PCIEG2              0x501
-+#define BCMA_CORE_DMA                 0x502
-+#define BCMA_CORE_SDIO3                       0x503
-+#define BCMA_CORE_USB20                       0x504
-+#define BCMA_CORE_USB30                       0x505
-+#define BCMA_CORE_A9JTAG              0x506
-+#define BCMA_CORE_DDR23                       0x507
-+#define BCMA_CORE_ROM                 0x508
-+#define BCMA_CORE_NAND                        0x509
-+#define BCMA_CORE_QSPI                        0x50A
-+#define BCMA_CORE_CHIPCOMMON_B                0x50B
++#define BCMA_CORE_NS_PCIEG2           0x501
++#define BCMA_CORE_NS_DMA              0x502
++#define BCMA_CORE_NS_SDIO3            0x503
++#define BCMA_CORE_NS_USB20            0x504
++#define BCMA_CORE_NS_USB30            0x505
++#define BCMA_CORE_NS_A9JTAG           0x506
++#define BCMA_CORE_NS_DDR23            0x507
++#define BCMA_CORE_NS_ROM              0x508
++#define BCMA_CORE_NS_NAND             0x509
++#define BCMA_CORE_NS_QSPI             0x50A
++#define BCMA_CORE_NS_CHIPCOMMON_B     0x50B
  #define BCMA_CORE_4706_SOC_RAM                0x50E
 +#define BCMA_CORE_ARMCA9              0x510
  #define BCMA_CORE_4706_MAC_GBIT               0x52D
  #define BCMA_CORE_AMEMC                       0x52E   /* DDR1/2 memory controller core */
  #define BCMA_CORE_ALTA                        0x534   /* I2S core */
-@@ -144,6 +156,7 @@ struct bcma_host_ops {
+@@ -144,6 +157,10 @@ struct bcma_host_ops {
  
  /* Chip IDs of PCIe devices */
  #define BCMA_CHIP_ID_BCM4313  0x4313
 +#define BCMA_CHIP_ID_BCM43142 43142
++#define BCMA_CHIP_ID_BCM43131 43131
++#define BCMA_CHIP_ID_BCM43217 43217
++#define BCMA_CHIP_ID_BCM43222 43222
  #define BCMA_CHIP_ID_BCM43224 43224
  #define  BCMA_PKG_ID_BCM43224_FAB_CSM 0x8
  #define  BCMA_PKG_ID_BCM43224_FAB_SMIC        0xa
-@@ -176,6 +189,11 @@ struct bcma_host_ops {
+@@ -176,6 +193,11 @@ struct bcma_host_ops {
  #define  BCMA_PKG_ID_BCM5357  11
  #define BCMA_CHIP_ID_BCM53572 53572
  #define  BCMA_PKG_ID_BCM47188 9
  
  /* Board types (on PCI usually equals to the subsystem dev id) */
  /* BCM4313 */
-@@ -400,7 +418,14 @@ static inline void bcma_maskset16(struct
+@@ -315,6 +337,7 @@ struct bcma_bus {
+       struct bcma_drv_cc drv_cc;
+       struct bcma_drv_pci drv_pci[2];
++      struct bcma_drv_pcie2 drv_pcie2;
+       struct bcma_drv_mips drv_mips;
+       struct bcma_drv_gmac_cmn drv_gmac_cmn;
+@@ -400,7 +423,14 @@ static inline void bcma_maskset16(struct
        bcma_write16(cc, offset, (bcma_read16(cc, offset) & mask) | set);
  }
  
  
  extern int bcma_core_pci_pcibios_map_irq(const struct pci_dev *dev);
  extern int bcma_core_pci_plat_dev_init(struct pci_dev *dev);
+--- /dev/null
++++ b/include/linux/bcma/bcma_driver_pcie2.h
+@@ -0,0 +1,158 @@
++#ifndef LINUX_BCMA_DRIVER_PCIE2_H_
++#define LINUX_BCMA_DRIVER_PCIE2_H_
++
++#define BCMA_CORE_PCIE2_CLK_CONTROL           0x0000
++#define  PCIE2_CLKC_RST_OE                    0x0001 /* When set, drives PCI_RESET out to pin */
++#define  PCIE2_CLKC_RST                               0x0002 /* Value driven out to pin */
++#define  PCIE2_CLKC_SPERST                    0x0004 /* SurvivePeRst */
++#define  PCIE2_CLKC_DISABLE_L1CLK_GATING      0x0010
++#define  PCIE2_CLKC_DLYPERST                  0x0100 /* Delay PeRst to CoE Core */
++#define  PCIE2_CLKC_DISSPROMLD                        0x0200 /* DisableSpromLoadOnPerst */
++#define  PCIE2_CLKC_WAKE_MODE_L2              0x1000 /* Wake on L2 */
++#define BCMA_CORE_PCIE2_RC_PM_CONTROL         0x0004
++#define BCMA_CORE_PCIE2_RC_PM_STATUS          0x0008
++#define BCMA_CORE_PCIE2_EP_PM_CONTROL         0x000C
++#define BCMA_CORE_PCIE2_EP_PM_STATUS          0x0010
++#define BCMA_CORE_PCIE2_EP_LTR_CONTROL                0x0014
++#define BCMA_CORE_PCIE2_EP_LTR_STATUS         0x0018
++#define BCMA_CORE_PCIE2_EP_OBFF_STATUS                0x001C
++#define BCMA_CORE_PCIE2_PCIE_ERR_STATUS               0x0020
++#define BCMA_CORE_PCIE2_RC_AXI_CONFIG         0x0100
++#define BCMA_CORE_PCIE2_EP_AXI_CONFIG         0x0104
++#define BCMA_CORE_PCIE2_RXDEBUG_STATUS0               0x0108
++#define BCMA_CORE_PCIE2_RXDEBUG_CONTROL0      0x010C
++#define BCMA_CORE_PCIE2_CONFIGINDADDR         0x0120
++#define BCMA_CORE_PCIE2_CONFIGINDDATA         0x0124
++#define BCMA_CORE_PCIE2_MDIOCONTROL           0x0128
++#define BCMA_CORE_PCIE2_MDIOWRDATA            0x012C
++#define BCMA_CORE_PCIE2_MDIORDDATA            0x0130
++#define BCMA_CORE_PCIE2_DATAINTF              0x0180
++#define BCMA_CORE_PCIE2_D2H_INTRLAZY_0                0x0188
++#define BCMA_CORE_PCIE2_H2D_INTRLAZY_0                0x018c
++#define BCMA_CORE_PCIE2_H2D_INTSTAT_0         0x0190
++#define BCMA_CORE_PCIE2_H2D_INTMASK_0         0x0194
++#define BCMA_CORE_PCIE2_D2H_INTSTAT_0         0x0198
++#define BCMA_CORE_PCIE2_D2H_INTMASK_0         0x019c
++#define BCMA_CORE_PCIE2_LTR_STATE             0x01A0 /* Latency Tolerance Reporting */
++#define  PCIE2_LTR_ACTIVE                     2
++#define  PCIE2_LTR_ACTIVE_IDLE                        1
++#define  PCIE2_LTR_SLEEP                      0
++#define  PCIE2_LTR_FINAL_MASK                 0x300
++#define  PCIE2_LTR_FINAL_SHIFT                        8
++#define BCMA_CORE_PCIE2_PWR_INT_STATUS                0x01A4
++#define BCMA_CORE_PCIE2_PWR_INT_MASK          0x01A8
++#define BCMA_CORE_PCIE2_CFG_ADDR              0x01F8
++#define BCMA_CORE_PCIE2_CFG_DATA              0x01FC
++#define BCMA_CORE_PCIE2_SYS_EQ_PAGE           0x0200
++#define BCMA_CORE_PCIE2_SYS_MSI_PAGE          0x0204
++#define BCMA_CORE_PCIE2_SYS_MSI_INTREN                0x0208
++#define BCMA_CORE_PCIE2_SYS_MSI_CTRL0         0x0210
++#define BCMA_CORE_PCIE2_SYS_MSI_CTRL1         0x0214
++#define BCMA_CORE_PCIE2_SYS_MSI_CTRL2         0x0218
++#define BCMA_CORE_PCIE2_SYS_MSI_CTRL3         0x021C
++#define BCMA_CORE_PCIE2_SYS_MSI_CTRL4         0x0220
++#define BCMA_CORE_PCIE2_SYS_MSI_CTRL5         0x0224
++#define BCMA_CORE_PCIE2_SYS_EQ_HEAD0          0x0250
++#define BCMA_CORE_PCIE2_SYS_EQ_TAIL0          0x0254
++#define BCMA_CORE_PCIE2_SYS_EQ_HEAD1          0x0258
++#define BCMA_CORE_PCIE2_SYS_EQ_TAIL1          0x025C
++#define BCMA_CORE_PCIE2_SYS_EQ_HEAD2          0x0260
++#define BCMA_CORE_PCIE2_SYS_EQ_TAIL2          0x0264
++#define BCMA_CORE_PCIE2_SYS_EQ_HEAD3          0x0268
++#define BCMA_CORE_PCIE2_SYS_EQ_TAIL3          0x026C
++#define BCMA_CORE_PCIE2_SYS_EQ_HEAD4          0x0270
++#define BCMA_CORE_PCIE2_SYS_EQ_TAIL4          0x0274
++#define BCMA_CORE_PCIE2_SYS_EQ_HEAD5          0x0278
++#define BCMA_CORE_PCIE2_SYS_EQ_TAIL5          0x027C
++#define BCMA_CORE_PCIE2_SYS_RC_INTX_EN                0x0330
++#define BCMA_CORE_PCIE2_SYS_RC_INTX_CSR               0x0334
++#define BCMA_CORE_PCIE2_SYS_MSI_REQ           0x0340
++#define BCMA_CORE_PCIE2_SYS_HOST_INTR_EN      0x0344
++#define BCMA_CORE_PCIE2_SYS_HOST_INTR_CSR     0x0348
++#define BCMA_CORE_PCIE2_SYS_HOST_INTR0                0x0350
++#define BCMA_CORE_PCIE2_SYS_HOST_INTR1                0x0354
++#define BCMA_CORE_PCIE2_SYS_HOST_INTR2                0x0358
++#define BCMA_CORE_PCIE2_SYS_HOST_INTR3                0x035C
++#define BCMA_CORE_PCIE2_SYS_EP_INT_EN0                0x0360
++#define BCMA_CORE_PCIE2_SYS_EP_INT_EN1                0x0364
++#define BCMA_CORE_PCIE2_SYS_EP_INT_CSR0               0x0370
++#define BCMA_CORE_PCIE2_SYS_EP_INT_CSR1               0x0374
++#define BCMA_CORE_PCIE2_SPROM(wordoffset)     (0x0800 + ((wordoffset) * 2))
++#define BCMA_CORE_PCIE2_FUNC0_IMAP0_0         0x0C00
++#define BCMA_CORE_PCIE2_FUNC0_IMAP0_1         0x0C04
++#define BCMA_CORE_PCIE2_FUNC0_IMAP0_2         0x0C08
++#define BCMA_CORE_PCIE2_FUNC0_IMAP0_3         0x0C0C
++#define BCMA_CORE_PCIE2_FUNC0_IMAP0_4         0x0C10
++#define BCMA_CORE_PCIE2_FUNC0_IMAP0_5         0x0C14
++#define BCMA_CORE_PCIE2_FUNC0_IMAP0_6         0x0C18
++#define BCMA_CORE_PCIE2_FUNC0_IMAP0_7         0x0C1C
++#define BCMA_CORE_PCIE2_FUNC1_IMAP0_0         0x0C20
++#define BCMA_CORE_PCIE2_FUNC1_IMAP0_1         0x0C24
++#define BCMA_CORE_PCIE2_FUNC1_IMAP0_2         0x0C28
++#define BCMA_CORE_PCIE2_FUNC1_IMAP0_3         0x0C2C
++#define BCMA_CORE_PCIE2_FUNC1_IMAP0_4         0x0C30
++#define BCMA_CORE_PCIE2_FUNC1_IMAP0_5         0x0C34
++#define BCMA_CORE_PCIE2_FUNC1_IMAP0_6         0x0C38
++#define BCMA_CORE_PCIE2_FUNC1_IMAP0_7         0x0C3C
++#define BCMA_CORE_PCIE2_FUNC0_IMAP1           0x0C80
++#define BCMA_CORE_PCIE2_FUNC1_IMAP1           0x0C88
++#define BCMA_CORE_PCIE2_FUNC0_IMAP2           0x0CC0
++#define BCMA_CORE_PCIE2_FUNC1_IMAP2           0x0CC8
++#define BCMA_CORE_PCIE2_IARR0_LOWER           0x0D00
++#define BCMA_CORE_PCIE2_IARR0_UPPER           0x0D04
++#define BCMA_CORE_PCIE2_IARR1_LOWER           0x0D08
++#define BCMA_CORE_PCIE2_IARR1_UPPER           0x0D0C
++#define BCMA_CORE_PCIE2_IARR2_LOWER           0x0D10
++#define BCMA_CORE_PCIE2_IARR2_UPPER           0x0D14
++#define BCMA_CORE_PCIE2_OARR0                 0x0D20
++#define BCMA_CORE_PCIE2_OARR1                 0x0D28
++#define BCMA_CORE_PCIE2_OARR2                 0x0D30
++#define BCMA_CORE_PCIE2_OMAP0_LOWER           0x0D40
++#define BCMA_CORE_PCIE2_OMAP0_UPPER           0x0D44
++#define BCMA_CORE_PCIE2_OMAP1_LOWER           0x0D48
++#define BCMA_CORE_PCIE2_OMAP1_UPPER           0x0D4C
++#define BCMA_CORE_PCIE2_OMAP2_LOWER           0x0D50
++#define BCMA_CORE_PCIE2_OMAP2_UPPER           0x0D54
++#define BCMA_CORE_PCIE2_FUNC1_IARR1_SIZE      0x0D58
++#define BCMA_CORE_PCIE2_FUNC1_IARR2_SIZE      0x0D5C
++#define BCMA_CORE_PCIE2_MEM_CONTROL           0x0F00
++#define BCMA_CORE_PCIE2_MEM_ECC_ERRLOG0               0x0F04
++#define BCMA_CORE_PCIE2_MEM_ECC_ERRLOG1               0x0F08
++#define BCMA_CORE_PCIE2_LINK_STATUS           0x0F0C
++#define BCMA_CORE_PCIE2_STRAP_STATUS          0x0F10
++#define BCMA_CORE_PCIE2_RESET_STATUS          0x0F14
++#define BCMA_CORE_PCIE2_RESETEN_IN_LINKDOWN   0x0F18
++#define BCMA_CORE_PCIE2_MISC_INTR_EN          0x0F1C
++#define BCMA_CORE_PCIE2_TX_DEBUG_CFG          0x0F20
++#define BCMA_CORE_PCIE2_MISC_CONFIG           0x0F24
++#define BCMA_CORE_PCIE2_MISC_STATUS           0x0F28
++#define BCMA_CORE_PCIE2_INTR_EN                       0x0F30
++#define BCMA_CORE_PCIE2_INTR_CLEAR            0x0F34
++#define BCMA_CORE_PCIE2_INTR_STATUS           0x0F38
++
++/* PCIE gen2 config regs */
++#define PCIE2_INTSTATUS                               0x090
++#define PCIE2_INTMASK                         0x094
++#define PCIE2_SBMBX                           0x098
++
++#define PCIE2_PMCR_REFUP                      0x1814 /* Trefup time */
++
++#define PCIE2_CAP_DEVSTSCTRL2_OFFSET          0xD4
++#define PCIE2_CAP_DEVSTSCTRL2_LTRENAB         0x400
++#define PCIE2_PVT_REG_PM_CLK_PERIOD           0x184c
++
++struct bcma_drv_pcie2 {
++      struct bcma_device *core;
++};
++
++#define pcie2_read16(pcie2, offset)           bcma_read16((pcie2)->core, offset)
++#define pcie2_read32(pcie2, offset)           bcma_read32((pcie2)->core, offset)
++#define pcie2_write16(pcie2, offset, val)     bcma_write16((pcie2)->core, offset, val)
++#define pcie2_write32(pcie2, offset, val)     bcma_write32((pcie2)->core, offset, val)
++
++#define pcie2_set32(pcie2, offset, set)               bcma_set32((pcie2)->core, offset, set)
++#define pcie2_mask32(pcie2, offset, mask)     bcma_mask32((pcie2)->core, offset, mask)
++
++void bcma_core_pcie2_init(struct bcma_drv_pcie2 *pcie2);
++
++#endif /* LINUX_BCMA_DRIVER_PCIE2_H_ */
 --- a/drivers/net/wireless/brcm80211/brcmsmac/aiutils.c
 +++ b/drivers/net/wireless/brcm80211/brcmsmac/aiutils.c
 @@ -679,27 +679,6 @@ bool ai_clkctl_cc(struct si_pub *sih, en
                        brcms_b_xtal(wlc_hw, OFF);
                }
        }
+--- a/drivers/bcma/driver_mips.c
++++ b/drivers/bcma/driver_mips.c
+@@ -21,6 +21,14 @@
+ #include <linux/serial_reg.h>
+ #include <linux/time.h>
++enum bcma_boot_dev {
++      BCMA_BOOT_DEV_UNK = 0,
++      BCMA_BOOT_DEV_ROM,
++      BCMA_BOOT_DEV_PARALLEL,
++      BCMA_BOOT_DEV_SERIAL,
++      BCMA_BOOT_DEV_NAND,
++};
++
+ static const char * const part_probes[] = { "bcm47xxpart", NULL };
+ static struct physmap_flash_data bcma_pflash_data = {
+@@ -229,11 +237,51 @@ u32 bcma_cpu_clock(struct bcma_drv_mips
+ }
+ EXPORT_SYMBOL(bcma_cpu_clock);
++static enum bcma_boot_dev bcma_boot_dev(struct bcma_bus *bus)
++{
++      struct bcma_drv_cc *cc = &bus->drv_cc;
++      u8 cc_rev = cc->core->id.rev;
++
++      if (cc_rev == 42) {
++              struct bcma_device *core;
++
++              core = bcma_find_core(bus, BCMA_CORE_NS_ROM);
++              if (core) {
++                      switch (bcma_aread32(core, BCMA_IOST) &
++                              BCMA_NS_ROM_IOST_BOOT_DEV_MASK) {
++                      case BCMA_NS_ROM_IOST_BOOT_DEV_NOR:
++                              return BCMA_BOOT_DEV_SERIAL;
++                      case BCMA_NS_ROM_IOST_BOOT_DEV_NAND:
++                              return BCMA_BOOT_DEV_NAND;
++                      case BCMA_NS_ROM_IOST_BOOT_DEV_ROM:
++                      default:
++                              return BCMA_BOOT_DEV_ROM;
++                      }
++              }
++      } else {
++              if (cc_rev == 38) {
++                      if (cc->status & BCMA_CC_CHIPST_5357_NAND_BOOT)
++                              return BCMA_BOOT_DEV_NAND;
++                      else if (cc->status & BIT(5))
++                              return BCMA_BOOT_DEV_ROM;
++              }
++
++              if ((cc->capabilities & BCMA_CC_CAP_FLASHT) ==
++                  BCMA_CC_FLASHT_PARA)
++                      return BCMA_BOOT_DEV_PARALLEL;
++              else
++                      return BCMA_BOOT_DEV_SERIAL;
++      }
++
++      return BCMA_BOOT_DEV_SERIAL;
++}
++
+ static void bcma_core_mips_flash_detect(struct bcma_drv_mips *mcore)
+ {
+       struct bcma_bus *bus = mcore->core->bus;
+       struct bcma_drv_cc *cc = &bus->drv_cc;
+       struct bcma_pflash *pflash = &cc->pflash;
++      enum bcma_boot_dev boot_dev;
+       switch (cc->capabilities & BCMA_CC_CAP_FLASHT) {
+       case BCMA_CC_FLASHT_STSER:
+@@ -269,6 +317,20 @@ static void bcma_core_mips_flash_detect(
+                       bcma_nflash_init(cc);
+               }
+       }
++
++      /* Determine flash type this SoC boots from */
++      boot_dev = bcma_boot_dev(bus);
++      switch (boot_dev) {
++      case BCMA_BOOT_DEV_PARALLEL:
++      case BCMA_BOOT_DEV_SERIAL:
++              /* TODO: Init NVRAM using BCMA_SOC_FLASH2 window */
++              break;
++      case BCMA_BOOT_DEV_NAND:
++              /* TODO: Init NVRAM using BCMA_SOC_FLASH1 window */
++              break;
++      default:
++              break;
++      }
+ }
+ void bcma_core_mips_early_init(struct bcma_drv_mips *mcore)
+--- a/drivers/bcma/host_soc.c
++++ b/drivers/bcma/host_soc.c
+@@ -134,12 +134,16 @@ static void bcma_host_soc_block_write(st
+ static u32 bcma_host_soc_aread32(struct bcma_device *core, u16 offset)
+ {
++      if (WARN_ONCE(!core->io_wrap, "Accessed core has no wrapper/agent\n"))
++              return ~0;
+       return readl(core->io_wrap + offset);
+ }
+ static void bcma_host_soc_awrite32(struct bcma_device *core, u16 offset,
+                                 u32 value)
+ {
++      if (WARN_ONCE(!core->io_wrap, "Accessed core has no wrapper/agent\n"))
++              return;
+       writel(value, core->io_wrap + offset);
+ }
+--- a/include/linux/bcma/bcma_regs.h
++++ b/include/linux/bcma/bcma_regs.h
+@@ -39,6 +39,11 @@
+ #define  BCMA_RESET_CTL_RESET         0x0001
+ #define BCMA_RESET_ST                 0x0804
++#define BCMA_NS_ROM_IOST_BOOT_DEV_MASK        0x0003
++#define BCMA_NS_ROM_IOST_BOOT_DEV_NOR 0x0000
++#define BCMA_NS_ROM_IOST_BOOT_DEV_NAND        0x0001
++#define BCMA_NS_ROM_IOST_BOOT_DEV_ROM 0x0002
++
+ /* BCMA PCI config space registers. */
+ #define BCMA_PCI_PMCSR                        0x44
+ #define  BCMA_PCI_PE                  0x100