dm thin metadata: factor out __write_initial_superblock
[linux-2.6-microblaze.git] / drivers / bcma / driver_chipcommon_pmu.c
index a8fcdf0..4432617 100644 (file)
@@ -3,7 +3,8 @@
  * ChipCommon Power Management Unit driver
  *
  * Copyright 2009, Michael Buesch <m@bues.ch>
- * Copyright 2007, Broadcom Corporation
+ * Copyright 2007, 2011, Broadcom Corporation
+ * Copyright 2011, 2012, Hauke Mehrtens <hauke@hauke-m.de>
  *
  * Licensed under the GNU/GPL. See COPYING for details.
  */
@@ -54,22 +55,6 @@ void bcma_chipco_regctl_maskset(struct bcma_drv_cc *cc, u32 offset, u32 mask,
 }
 EXPORT_SYMBOL_GPL(bcma_chipco_regctl_maskset);
 
-static void bcma_pmu_pll_init(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_BCM4331:
-       case BCMA_CHIP_ID_BCM43224:
-       case BCMA_CHIP_ID_BCM43225:
-               break;
-       default:
-               pr_err("PLL init unknown for device 0x%04X\n",
-                       bus->chipinfo.id);
-       }
-}
-
 static void bcma_pmu_resources_init(struct bcma_drv_cc *cc)
 {
        struct bcma_bus *bus = cc->core->bus;
@@ -80,13 +65,9 @@ static void bcma_pmu_resources_init(struct bcma_drv_cc *cc)
                min_msk = 0x200D;
                max_msk = 0xFFFF;
                break;
-       case BCMA_CHIP_ID_BCM4331:
-       case BCMA_CHIP_ID_BCM43224:
-       case BCMA_CHIP_ID_BCM43225:
-               break;
        default:
-               pr_err("PMU resource config unknown for device 0x%04X\n",
-                       bus->chipinfo.id);
+               bcma_debug(bus, "PMU resource config unknown or not needed for device 0x%04X\n",
+                          bus->chipinfo.id);
        }
 
        /* Set the resource masks. */
@@ -94,22 +75,9 @@ static void bcma_pmu_resources_init(struct bcma_drv_cc *cc)
                bcma_cc_write32(cc, BCMA_CC_PMU_MINRES_MSK, min_msk);
        if (max_msk)
                bcma_cc_write32(cc, BCMA_CC_PMU_MAXRES_MSK, max_msk);
-}
 
-void bcma_pmu_swreg_init(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_BCM4331:
-       case BCMA_CHIP_ID_BCM43224:
-       case BCMA_CHIP_ID_BCM43225:
-               break;
-       default:
-               pr_err("PMU switch/regulators init unknown for device "
-                       "0x%04X\n", bus->chipinfo.id);
-       }
+       /* Add some delay; allow resources to come up and settle. */
+       mdelay(2);
 }
 
 /* Disable to allow reading SPROM. Don't know the adventages of enabling it. */
@@ -167,11 +135,9 @@ void bcma_pmu_workarounds(struct bcma_drv_cc *cc)
                                                    BCMA_CCTRL_43224B0_12MA_LED_DRIVE);
                }
                break;
-       case BCMA_CHIP_ID_BCM43225:
-               break;
        default:
-               pr_err("Workarounds unknown for device 0x%04X\n",
-                       bus->chipinfo.id);
+               bcma_debug(bus, "Workarounds unknown or not needed for device 0x%04X\n",
+                          bus->chipinfo.id);
        }
 }
 
@@ -182,8 +148,8 @@ void bcma_pmu_init(struct bcma_drv_cc *cc)
        pmucap = bcma_cc_read32(cc, BCMA_CC_PMU_CAP);
        cc->pmu.rev = (pmucap & BCMA_CC_PMU_CAP_REVISION);
 
-       pr_debug("Found rev %u PMU (capabilities 0x%08X)\n", cc->pmu.rev,
-                pmucap);
+       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,
@@ -192,9 +158,7 @@ void bcma_pmu_init(struct bcma_drv_cc *cc)
                bcma_cc_set32(cc, BCMA_CC_PMU_CTL,
                             BCMA_CC_PMU_CTL_NOILPONW);
 
-       bcma_pmu_pll_init(cc);
        bcma_pmu_resources_init(cc);
-       bcma_pmu_swreg_init(cc);
        bcma_pmu_workarounds(cc);
 }
 
@@ -217,9 +181,8 @@ u32 bcma_pmu_alp_clock(struct bcma_drv_cc *cc)
                /* always 25Mhz */
                return 25000 * 1000;
        default:
-               pr_warn("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);
+               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);
        }
        return BCMA_CC_PMU_ALP_CLOCK;
 }
@@ -263,6 +226,36 @@ static u32 bcma_pmu_clock(struct bcma_drv_cc *cc, u32 pll0, u32 m)
        return (fc / div) * 1000000;
 }
 
+static u32 bcma_pmu_clock_bcm4706(struct bcma_drv_cc *cc, u32 pll0, u32 m)
+{
+       u32 tmp, ndiv, p1div, p2div;
+       u32 clock;
+
+       BUG_ON(!m || m > 4);
+
+       /* Get N, P1 and P2 dividers to determine CPU clock */
+       tmp = bcma_chipco_pll_read(cc, pll0 + BCMA_CC_PMU6_4706_PROCPLL_OFF);
+       ndiv = (tmp & BCMA_CC_PMU6_4706_PROC_NDIV_INT_MASK)
+               >> BCMA_CC_PMU6_4706_PROC_NDIV_INT_SHIFT;
+       p1div = (tmp & BCMA_CC_PMU6_4706_PROC_P1DIV_MASK)
+               >> BCMA_CC_PMU6_4706_PROC_P1DIV_SHIFT;
+       p2div = (tmp & BCMA_CC_PMU6_4706_PROC_P2DIV_MASK)
+               >> BCMA_CC_PMU6_4706_PROC_P2DIV_SHIFT;
+
+       tmp = bcma_cc_read32(cc, BCMA_CC_CHIPSTAT);
+       if (tmp & BCMA_CC_CHIPST_4706_PKG_OPTION)
+               /* Low cost bonding: Fixed reference clock 25MHz and m = 4 */
+               clock = (25000000 / 4) * ndiv * p2div / p1div;
+       else
+               /* Fixed reference clock 25MHz and m = 2 */
+               clock = (25000000 / 2) * ndiv * p2div / p1div;
+
+       if (m == BCMA_CC_PMU5_MAINPLL_SSB)
+               clock = clock / 4;
+
+       return clock;
+}
+
 /* query bus clock frequency for PMU-enabled chipcommon */
 u32 bcma_pmu_get_clockcontrol(struct bcma_drv_cc *cc)
 {
@@ -282,14 +275,13 @@ u32 bcma_pmu_get_clockcontrol(struct bcma_drv_cc *cc)
                return bcma_pmu_clock(cc, BCMA_CC_PMU5357_MAINPLL_PLL0,
                                      BCMA_CC_PMU5_MAINPLL_SSB);
        case BCMA_CHIP_ID_BCM4706:
-               return bcma_pmu_clock(cc, BCMA_CC_PMU4706_MAINPLL_PLL0,
-                                     BCMA_CC_PMU5_MAINPLL_SSB);
+               return bcma_pmu_clock_bcm4706(cc, BCMA_CC_PMU4706_MAINPLL_PLL0,
+                                             BCMA_CC_PMU5_MAINPLL_SSB);
        case BCMA_CHIP_ID_BCM53572:
                return 75000000;
        default:
-               pr_warn("No backplane clock specified for %04X device, "
-                       "pmu rev. %d, using default %d Hz\n",
-                       bus->chipinfo.id, cc->pmu.rev, BCMA_CC_PMU_HT_CLOCK);
+               bcma_warn(bus, "No backplane 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;
 }
@@ -305,6 +297,10 @@ u32 bcma_pmu_get_clockcpu(struct bcma_drv_cc *cc)
        if (cc->pmu.rev >= 5) {
                u32 pll;
                switch (bus->chipinfo.id) {
+               case BCMA_CHIP_ID_BCM4706:
+                       return bcma_pmu_clock_bcm4706(cc,
+                                               BCMA_CC_PMU4706_MAINPLL_PLL0,
+                                               BCMA_CC_PMU5_MAINPLL_CPU);
                case BCMA_CHIP_ID_BCM5356:
                        pll = BCMA_CC_PMU5356_MAINPLL_PLL0;
                        break;
@@ -317,10 +313,188 @@ u32 bcma_pmu_get_clockcpu(struct bcma_drv_cc *cc)
                        break;
                }
 
-               /* TODO: if (bus->chipinfo.id == BCMA_CHIP_ID_BCM4706)
-                 return si_4706_pmu_clock(sih, osh, cc, PMU4706_MAINPLL_PLL0, PMU5_MAINPLL_CPU); */
                return bcma_pmu_clock(cc, pll, BCMA_CC_PMU5_MAINPLL_CPU);
        }
 
        return bcma_pmu_get_clockcontrol(cc);
 }
+
+static void bcma_pmu_spuravoid_pll_write(struct bcma_drv_cc *cc, u32 offset,
+                                        u32 value)
+{
+       bcma_cc_write32(cc, BCMA_CC_PLLCTL_ADDR, offset);
+       bcma_cc_write32(cc, BCMA_CC_PLLCTL_DATA, value);
+}
+
+void bcma_pmu_spuravoid_pllupdate(struct bcma_drv_cc *cc, int spuravoid)
+{
+       u32 tmp = 0;
+       u8 phypll_offset = 0;
+       u8 bcm5357_bcm43236_p1div[] = {0x1, 0x5, 0x5};
+       u8 bcm5357_bcm43236_ndiv[] = {0x30, 0xf6, 0xfc};
+       struct bcma_bus *bus = cc->core->bus;
+
+       switch (bus->chipinfo.id) {
+       case BCMA_CHIP_ID_BCM5357:
+       case BCMA_CHIP_ID_BCM4749:
+       case BCMA_CHIP_ID_BCM53572:
+               /* 5357[ab]0, 43236[ab]0, and 6362b0 */
+
+               /* BCM5357 needs to touch PLL1_PLLCTL[02],
+                  so offset PLL0_PLLCTL[02] by 6 */
+               phypll_offset = (bus->chipinfo.id == BCMA_CHIP_ID_BCM5357 ||
+                      bus->chipinfo.id == BCMA_CHIP_ID_BCM4749 ||
+                      bus->chipinfo.id == BCMA_CHIP_ID_BCM53572) ? 6 : 0;
+
+               /* RMW only the P1 divider */
+               bcma_cc_write32(cc, BCMA_CC_PLLCTL_ADDR,
+                               BCMA_CC_PMU_PLL_CTL0 + phypll_offset);
+               tmp = bcma_cc_read32(cc, BCMA_CC_PLLCTL_DATA);
+               tmp &= (~(BCMA_CC_PMU1_PLL0_PC0_P1DIV_MASK));
+               tmp |= (bcm5357_bcm43236_p1div[spuravoid] << BCMA_CC_PMU1_PLL0_PC0_P1DIV_SHIFT);
+               bcma_cc_write32(cc, BCMA_CC_PLLCTL_DATA, tmp);
+
+               /* RMW only the int feedback divider */
+               bcma_cc_write32(cc, BCMA_CC_PLLCTL_ADDR,
+                               BCMA_CC_PMU_PLL_CTL2 + phypll_offset);
+               tmp = bcma_cc_read32(cc, BCMA_CC_PLLCTL_DATA);
+               tmp &= ~(BCMA_CC_PMU1_PLL0_PC2_NDIV_INT_MASK);
+               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;
+               break;
+
+       case BCMA_CHIP_ID_BCM4331:
+       case BCMA_CHIP_ID_BCM43431:
+               if (spuravoid == 2) {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x11500014);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x0FC00a08);
+               } else if (spuravoid == 1) {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x11500014);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x0F600a08);
+               } else {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x11100014);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x03000a08);
+               }
+               tmp = 1 << 10;
+               break;
+
+       case BCMA_CHIP_ID_BCM43224:
+       case BCMA_CHIP_ID_BCM43225:
+       case BCMA_CHIP_ID_BCM43421:
+               if (spuravoid == 1) {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x11500010);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL1,
+                                                    0x000C0C06);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x0F600a08);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL3,
+                                                    0x00000000);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL4,
+                                                    0x2001E920);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL5,
+                                                    0x88888815);
+               } else {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x11100010);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL1,
+                                                    0x000c0c06);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x03000a08);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL3,
+                                                    0x00000000);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL4,
+                                                    0x200005c0);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL5,
+                                                    0x88888815);
+               }
+               tmp = 1 << 10;
+               break;
+
+       case BCMA_CHIP_ID_BCM4716:
+       case BCMA_CHIP_ID_BCM4748:
+       case BCMA_CHIP_ID_BCM47162:
+               if (spuravoid == 1) {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x11500060);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL1,
+                                                    0x080C0C06);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x0F600000);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL3,
+                                                    0x00000000);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL4,
+                                                    0x2001E924);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL5,
+                                                    0x88888815);
+               } else {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x11100060);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL1,
+                                                    0x080c0c06);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x03000000);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL3,
+                                                    0x00000000);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL4,
+                                                    0x200005c0);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL5,
+                                                    0x88888815);
+               }
+
+               tmp = 3 << 9;
+               break;
+
+       case BCMA_CHIP_ID_BCM43227:
+       case BCMA_CHIP_ID_BCM43228:
+       case BCMA_CHIP_ID_BCM43428:
+               /* LCNXN */
+               /* PLL Settings for spur avoidance on/off mode,
+                  no on2 support for 43228A0 */
+               if (spuravoid == 1) {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x01100014);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL1,
+                                                    0x040C0C06);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x03140A08);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL3,
+                                                    0x00333333);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL4,
+                                                    0x202C2820);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL5,
+                                                    0x88888815);
+               } else {
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL0,
+                                                    0x11100014);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL1,
+                                                    0x040c0c06);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL2,
+                                                    0x03000a08);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL3,
+                                                    0x00000000);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL4,
+                                                    0x200005c0);
+                       bcma_pmu_spuravoid_pll_write(cc, BCMA_CC_PMU_PLL_CTL5,
+                                                    0x88888815);
+               }
+               tmp = 1 << 10;
+               break;
+       default:
+               bcma_err(bus, "Unknown spuravoidance settings for chip 0x%04X, not changing PLL\n",
+                        bus->chipinfo.id);
+               break;
+       }
+
+       tmp |= bcma_cc_read32(cc, BCMA_CC_PMU_CTL);
+       bcma_cc_write32(cc, BCMA_CC_PMU_CTL, tmp);
+}
+EXPORT_SYMBOL_GPL(bcma_pmu_spuravoid_pllupdate);