omap4: Adding PBIAS Configuration for MMC1 Controller

In OMAP4, MMC1 PBIAS and its associated IO is software-controlled
by CONTROL_PBIAS and CONTROL_MMC1 registers. This patch adds PBIAS
configuration for MMC1 Controller during power-ON and power-OFF
of regulator.

Signed-off-by: Kishore Kadiyala <kishore.kadiyala@ti.com>
Signed-off-by: Tony Lindgren <tony@atomide.com>

1 files changed, 88 insertions, 9 deletions

diff --git a/arch/arm/mach-omap2/hsmmc.c b/arch/arm/mach-omap2/hsmmc.c
index 2d36f3afbd4e..1ef54b036103 100644
--- a/arch/arm/mach-omap2/hsmmc.c
+++ b/arch/arm/mach-omap2/hsmmc.c
@@ -24,6 +24,7 @@
 
 static u16 control_pbias_offset;
 static u16 control_devconf1_offset;
+static u16 control_mmc1;
 
 #define HSMMC_NAME_LEN  9
 
@@ -42,7 +43,7 @@ static int hsmmc_get_context_loss(struct device *dev)
 #define hsmmc_get_context_loss NULL
 #endif
 
-static void hsmmc1_before_set_reg(struct device *dev, int slot,
+static void omap_hsmmc1_before_set_reg(struct device *dev, int slot,
                                   int power_on, int vdd)
 {
         u32 reg, prog_io;
@@ -95,7 +96,7 @@ static void hsmmc1_before_set_reg(struct device *dev, int slot,
         }
 }
 
-static void hsmmc1_after_set_reg(struct device *dev, int slot,
+static void omap_hsmmc1_after_set_reg(struct device *dev, int slot,
                                  int power_on, int vdd)
 {
         u32 reg;
@@ -119,6 +120,60 @@ static void hsmmc1_after_set_reg(struct device *dev, int slot,
         }
 }
 
+static void omap4_hsmmc1_before_set_reg(struct device *dev, int slot,
+                                  int power_on, int vdd)
+{
+        u32 reg;
+
+        /*
+         * Assume we power both OMAP VMMC1 (for CMD, CLK, DAT0..3) and the
+         * card with Vcc regulator (from twl4030 or whatever).  OMAP has both
+         * 1.8V and 3.0V modes, controlled by the PBIAS register.
+         *
+         * In 8-bit modes, OMAP VMMC1A (for DAT4..7) needs a supply, which
+         * is most naturally TWL VSIM; those pins also use PBIAS.
+         *
+         * FIXME handle VMMC1A as needed ...
+         */
+        reg = omap_ctrl_readl(control_pbias_offset);
+        reg &= ~(OMAP4_MMC1_PBIASLITE_PWRDNZ | OMAP4_MMC1_PWRDNZ |
+                                        OMAP4_USBC1_ICUSB_PWRDNZ);
+        omap_ctrl_writel(reg, control_pbias_offset);
+}
+
+static void omap4_hsmmc1_after_set_reg(struct device *dev, int slot,
+                                 int power_on, int vdd)
+{
+        u32 reg;
+
+        if (power_on) {
+                reg = omap_ctrl_readl(control_pbias_offset);
+                reg |= OMAP4_MMC1_PBIASLITE_PWRDNZ;
+                if ((1 << vdd) <= MMC_VDD_165_195)
+                        reg &= ~OMAP4_MMC1_PBIASLITE_VMODE;
+                else
+                        reg |= OMAP4_MMC1_PBIASLITE_VMODE;
+                reg |= (OMAP4_MMC1_PBIASLITE_PWRDNZ | OMAP4_MMC1_PWRDNZ |
+                                                OMAP4_USBC1_ICUSB_PWRDNZ);
+                omap_ctrl_writel(reg, control_pbias_offset);
+                /* 4 microsec delay for comparator to generate an error*/
+                udelay(4);
+                reg = omap_ctrl_readl(control_pbias_offset);
+                if (reg & OMAP4_MMC1_PBIASLITE_VMODE_ERROR) {
+                        pr_err("Pbias Voltage is not same as LDO\n");
+                        /* Caution : On VMODE_ERROR Power Down MMC IO */
+                        reg &= ~(OMAP4_MMC1_PWRDNZ | OMAP4_USBC1_ICUSB_PWRDNZ);
+                        omap_ctrl_writel(reg, control_pbias_offset);
+                }
+        } else {
+                reg = omap_ctrl_readl(control_pbias_offset);
+                 reg |= (OMAP4_MMC1_PBIASLITE_PWRDNZ |
+                        OMAP4_MMC1_PBIASLITE_VMODE | OMAP4_MMC1_PWRDNZ |
+                        OMAP4_USBC1_ICUSB_PWRDNZ);
+                omap_ctrl_writel(reg, control_pbias_offset);
+        }
+}
+
 static void hsmmc23_before_set_reg(struct device *dev, int slot,
                                    int power_on, int vdd)
 {
@@ -152,13 +207,28 @@ void __init omap2_hsmmc_init(struct omap2_hsmmc_info *controllers)
         struct omap2_hsmmc_info *c;
         int nr_hsmmc = ARRAY_SIZE(hsmmc_data);
         int i;
+        u32 reg;
 
-        if (cpu_is_omap2430()) {
-                control_pbias_offset = OMAP243X_CONTROL_PBIAS_LITE;
-                control_devconf1_offset = OMAP243X_CONTROL_DEVCONF1;
+        if (!cpu_is_omap44xx()) {
+                if (cpu_is_omap2430()) {
+                        control_pbias_offset = OMAP243X_CONTROL_PBIAS_LITE;
+                        control_devconf1_offset = OMAP243X_CONTROL_DEVCONF1;
+                } else {
+                        control_pbias_offset = OMAP343X_CONTROL_PBIAS_LITE;
+                        control_devconf1_offset = OMAP343X_CONTROL_DEVCONF1;
+                }
         } else {
-                control_pbias_offset = OMAP343X_CONTROL_PBIAS_LITE;
-                control_devconf1_offset = OMAP343X_CONTROL_DEVCONF1;
+                control_pbias_offset = OMAP44XX_CONTROL_PBIAS_LITE;
+                control_mmc1 = OMAP44XX_CONTROL_MMC1;
+                reg = omap_ctrl_readl(control_mmc1);
+                reg |= (OMAP4_CONTROL_SDMMC1_PUSTRENGTHGRP0 |
+                        OMAP4_CONTROL_SDMMC1_PUSTRENGTHGRP1);
+                reg &= ~(OMAP4_CONTROL_SDMMC1_PUSTRENGTHGRP2 |
+                        OMAP4_CONTROL_SDMMC1_PUSTRENGTHGRP3);
+                reg |= (OMAP4_CONTROL_SDMMC1_DR0_SPEEDCTRL |
+                        OMAP4_CONTROL_SDMMC1_DR1_SPEEDCTRL |
+                        OMAP4_CONTROL_SDMMC1_DR2_SPEEDCTRL);
+                omap_ctrl_writel(reg, control_mmc1);
         }
 
         for (c = controllers; c->mmc; c++) {
@@ -231,8 +301,17 @@ void __init omap2_hsmmc_init(struct omap2_hsmmc_info *controllers)
                 case 1:
                         if (mmc->slots[0].features & HSMMC_HAS_PBIAS) {
                                 /* on-chip level shifting via PBIAS0/PBIAS1 */
-                                mmc->slots[0].before_set_reg = hsmmc1_before_set_reg;
-                                mmc->slots[0].after_set_reg = hsmmc1_after_set_reg;
+                                if (cpu_is_omap44xx()) {
+                                        mmc->slots[0].before_set_reg =
+                                                omap4_hsmmc1_before_set_reg;
+                                        mmc->slots[0].after_set_reg =
+                                                omap4_hsmmc1_after_set_reg;
+                                } else {
+                                        mmc->slots[0].before_set_reg =
+                                                omap_hsmmc1_before_set_reg;
+                                        mmc->slots[0].after_set_reg =
+                                                omap_hsmmc1_after_set_reg;
+                                }
                         }
 
                         /* Omap3630 HSMMC1 supports only 4-bit */