mmc: fsl_esdhc: fix sd/mmc ddr mode clock setting issue
When sd/mmc work at DDR mode, like HS400/HS400ES/DDR52/DDR50 mode, the output clock rate is half of the internal clock rate. This patch set the DDR_EN bit first for DDR mode, hardware divide the usdhc clock automatically, then follow the original sdr clock setting method. Signed-off-by: Haibo Chen <haibo.chen@nxp.com> Signed-off-by: Ye Li <ye.li@nxp.com>
This commit is contained in:
@@ -614,18 +614,31 @@ static void set_sysctl(struct fsl_esdhc_priv *priv, struct mmc *mmc, uint clock)
|
|||||||
#else
|
#else
|
||||||
int pre_div = 2;
|
int pre_div = 2;
|
||||||
#endif
|
#endif
|
||||||
int ddr_pre_div = mmc->ddr_mode ? 2 : 1;
|
|
||||||
int sdhc_clk = priv->sdhc_clk;
|
int sdhc_clk = priv->sdhc_clk;
|
||||||
uint clk;
|
uint clk;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* For ddr mode, usdhc need to enable DDR mode first, after select
|
||||||
|
* this DDR mode, usdhc will automatically divide the usdhc clock
|
||||||
|
*/
|
||||||
|
if (mmc->ddr_mode) {
|
||||||
|
writel(readl(®s->mixctrl) | MIX_CTRL_DDREN, ®s->mixctrl);
|
||||||
|
sdhc_clk >>= 1;
|
||||||
|
}
|
||||||
|
|
||||||
if (clock < mmc->cfg->f_min)
|
if (clock < mmc->cfg->f_min)
|
||||||
clock = mmc->cfg->f_min;
|
clock = mmc->cfg->f_min;
|
||||||
|
|
||||||
while (sdhc_clk / (16 * pre_div * ddr_pre_div) > clock && pre_div < 256)
|
if (sdhc_clk / 16 > clock) {
|
||||||
pre_div *= 2;
|
for (; pre_div < 256; pre_div *= 2)
|
||||||
|
if ((sdhc_clk / pre_div) <= (clock * 16))
|
||||||
|
break;
|
||||||
|
} else
|
||||||
|
pre_div = 1;
|
||||||
|
|
||||||
while (sdhc_clk / (div * pre_div * ddr_pre_div) > clock && div < 16)
|
for (div = 1; div <= 16; div++)
|
||||||
div++;
|
if ((sdhc_clk / (div * pre_div)) <= clock)
|
||||||
|
break;
|
||||||
|
|
||||||
pre_div >>= 1;
|
pre_div >>= 1;
|
||||||
div -= 1;
|
div -= 1;
|
||||||
|
Reference in New Issue
Block a user