mmc: fsl_esdhc: Fix 'Internal clock never stabilised.' error

Only newer eSDHC controllers set PRSSTAT_SDSTB flag. So do not wait until
flag PRSSTAT_SDSTB is set on old pre-2.2 controllers. Instead sleep for
fixed amount of time like it was before commit 977f41e2aab2 ("mmc:
fsl_esdhc: Add emmc hs200 support").

This change fixes error 'Internal clock never stabilised.' which is printed
on P2020 board at every access to SD card.

Fixes: 977f41e2aab2 ("mmc: fsl_esdhc: Add emmc hs200 support")
Signed-off-by: Pali Rohár <pali@kernel.org>
Reviewed-by: Jaehoon Chung <jh80.chung@samsung.com>
Reviewed-by: Jaehoon Chung <jh80.chung@samsung.com>

diff --git a/drivers/mmc/fsl_esdhc.c b/drivers/mmc/fsl_esdhc.c
index b49a7b425b9a01c64d37cd8747b5c68c05585727..ca5a87969f88ea03638613300e2fa66fa3d95de1 100644 (file)
--- a/drivers/mmc/fsl_esdhc.c
+++ b/drivers/mmc/fsl_esdhc.c
@@ -504,6 +504,7 @@ static void set_sysctl(struct fsl_esdhc_priv *priv, struct mmc *mmc, uint clock)
        u32 time_out;
        u32 value;
        uint clk;
+       u32 hostver;
 
        if (clock < mmc->cfg->f_min)
                clock = mmc->cfg->f_min;
@@ -544,6 +545,14 @@ static void set_sysctl(struct fsl_esdhc_priv *priv, struct mmc *mmc, uint clock)
 
        esdhc_clrsetbits32(&regs->sysctl, SYSCTL_CLOCK_MASK, clk);
 
+       /* Only newer eSDHC controllers set PRSSTAT_SDSTB flag */
+       hostver = esdhc_read32(&priv->esdhc_regs->hostver);
+       if (HOSTVER_VENDOR(hostver) <= VENDOR_V_22) {
+               udelay(10000);
+               esdhc_setbits32(&regs->sysctl, SYSCTL_PEREN | SYSCTL_CKEN);
+               return;
+       }
+
        time_out = 20;
        value = PRSSTAT_SDSTB;
        while (!(esdhc_read32(&regs->prsstat) & value)) {
@@ -563,6 +572,7 @@ static void esdhc_clock_control(struct fsl_esdhc_priv *priv, bool enable)
        struct fsl_esdhc *regs = priv->esdhc_regs;
        u32 value;
        u32 time_out;
+       u32 hostver;
 
        value = esdhc_read32(&regs->sysctl);
 
@@ -573,6 +583,13 @@ static void esdhc_clock_control(struct fsl_esdhc_priv *priv, bool enable)
 
        esdhc_write32(&regs->sysctl, value);
 
+       /* Only newer eSDHC controllers set PRSSTAT_SDSTB flag */
+       hostver = esdhc_read32(&priv->esdhc_regs->hostver);
+       if (HOSTVER_VENDOR(hostver) <= VENDOR_V_22) {
+               udelay(10000);
+               return;
+       }
+
        time_out = 20;
        value = PRSSTAT_SDSTB;
        while (!(esdhc_read32(&regs->prsstat) & value)) {