mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-11-22 19:21:57 +01:00
mmc: tmio: Reorder TMIO clock handling
Reorder the tmio_sd_set_clk_rate() function such that it handles all
of the clock requiests correctly. Specifically, before this patch,
clock request with (mmc->clock == 0 && mmc->clk_disable) could leave
the clock enabled, as the function would exit on if (!mmc->clock)
condition on top and will not handle the mmc->clk_disable at all.
Rather than band-aid fixing just that particular problem, reorder
the entire function to make it easier to understand and verify that
all the cases are covered. The function has three sections now:
First, if mmc->clock != 0, we calculate divider for the SD block.
Second, if mmc->clock != 0 and SD block clock are enabled and
current divider is not equal to the new divider, then
stop the clock and update the divider.
Third, if mmc->clk_disable is set, disable the clock, otherwise
enable the clock. This happens independently of divider
update now.
Signed-off-by: Marek Vasut <marek.vasut+renesas@gmail.com>
Cc: Masahiro Yamada <yamada.masahiro@socionext.com>
This commit is contained in:
parent
59d529afdc
commit
ed427dab2e
@ -560,16 +560,13 @@ static ulong tmio_sd_clk_get_rate(struct tmio_sd_priv *priv)
|
|||||||
return priv->clk_get_rate(priv);
|
return priv->clk_get_rate(priv);
|
||||||
}
|
}
|
||||||
|
|
||||||
static void tmio_sd_set_clk_rate(struct tmio_sd_priv *priv,
|
static void tmio_sd_set_clk_rate(struct tmio_sd_priv *priv, struct mmc *mmc)
|
||||||
struct mmc *mmc)
|
|
||||||
{
|
{
|
||||||
unsigned int divisor;
|
unsigned int divisor;
|
||||||
u32 val, tmp;
|
u32 tmp, val = 0;
|
||||||
ulong mclk;
|
ulong mclk;
|
||||||
|
|
||||||
if (!mmc->clock)
|
if (mmc->clock) {
|
||||||
return;
|
|
||||||
|
|
||||||
mclk = tmio_sd_clk_get_rate(priv);
|
mclk = tmio_sd_clk_get_rate(priv);
|
||||||
|
|
||||||
divisor = DIV_ROUND_UP(mclk, mmc->clock);
|
divisor = DIV_ROUND_UP(mclk, mmc->clock);
|
||||||
@ -601,27 +598,33 @@ static void tmio_sd_set_clk_rate(struct tmio_sd_priv *priv,
|
|||||||
val = TMIO_SD_CLKCTL_DIV512;
|
val = TMIO_SD_CLKCTL_DIV512;
|
||||||
else
|
else
|
||||||
val = TMIO_SD_CLKCTL_DIV1024;
|
val = TMIO_SD_CLKCTL_DIV1024;
|
||||||
|
}
|
||||||
|
|
||||||
tmp = tmio_sd_readl(priv, TMIO_SD_CLKCTL);
|
tmp = tmio_sd_readl(priv, TMIO_SD_CLKCTL);
|
||||||
if (tmp & TMIO_SD_CLKCTL_SCLKEN &&
|
if (mmc->clock &&
|
||||||
(tmp & TMIO_SD_CLKCTL_DIV_MASK) == val)
|
!((tmp & TMIO_SD_CLKCTL_SCLKEN) &&
|
||||||
return;
|
((tmp & TMIO_SD_CLKCTL_DIV_MASK) == val))) {
|
||||||
|
/*
|
||||||
/* stop the clock before changing its rate to avoid a glitch signal */
|
* Stop the clock before changing its rate
|
||||||
|
* to avoid a glitch signal
|
||||||
|
*/
|
||||||
tmp &= ~TMIO_SD_CLKCTL_SCLKEN;
|
tmp &= ~TMIO_SD_CLKCTL_SCLKEN;
|
||||||
tmio_sd_writel(priv, tmp, TMIO_SD_CLKCTL);
|
tmio_sd_writel(priv, tmp, TMIO_SD_CLKCTL);
|
||||||
|
|
||||||
|
/* Change the clock rate. */
|
||||||
tmp &= ~TMIO_SD_CLKCTL_DIV_MASK;
|
tmp &= ~TMIO_SD_CLKCTL_DIV_MASK;
|
||||||
tmp |= val;
|
tmp |= val;
|
||||||
tmio_sd_writel(priv, tmp, TMIO_SD_CLKCTL);
|
}
|
||||||
|
|
||||||
if (!mmc->clk_disable) {
|
/* Enable or Disable the clock */
|
||||||
tmp &= ~TMIO_SD_CLKCTL_OFFEN;
|
if (mmc->clk_disable) {
|
||||||
tmp |= TMIO_SD_CLKCTL_SCLKEN;
|
|
||||||
} else {
|
|
||||||
tmp |= TMIO_SD_CLKCTL_OFFEN;
|
tmp |= TMIO_SD_CLKCTL_OFFEN;
|
||||||
tmp &= ~TMIO_SD_CLKCTL_SCLKEN;
|
tmp &= ~TMIO_SD_CLKCTL_SCLKEN;
|
||||||
|
} else {
|
||||||
|
tmp &= ~TMIO_SD_CLKCTL_OFFEN;
|
||||||
|
tmp |= TMIO_SD_CLKCTL_SCLKEN;
|
||||||
}
|
}
|
||||||
|
|
||||||
tmio_sd_writel(priv, tmp, TMIO_SD_CLKCTL);
|
tmio_sd_writel(priv, tmp, TMIO_SD_CLKCTL);
|
||||||
|
|
||||||
udelay(1000);
|
udelay(1000);
|
||||||
|
|||||||
Loading…
x
Reference in New Issue
Block a user