Commit 23f785a8 authored by Charles Keepax's avatar Charles Keepax Committed by Mark Brown

ASoC: arizona: Move calculation of FLL configuration

Currently the FLL configuration is calculated before it is known which
FLL path the configuration will be applied to. Newer versions of the IP
have differences in the configuration required for each FLL path, which
makes it complicated to calculate the FLL configuration in advance.

This patch simply checks the validity of a requested input and output
frequency before we know which FLL path they will be applied to and
saves the actual calculation of the configuration until we know where
the settings will be applied.
Signed-off-by: default avatarCharles Keepax <ckeepax@opensource.wolfsonmicro.com>
Signed-off-by: default avatarMark Brown <broonie@linaro.org>
parent 61719db8
...@@ -1383,6 +1383,29 @@ struct arizona_fll_cfg { ...@@ -1383,6 +1383,29 @@ struct arizona_fll_cfg {
int gain; int gain;
}; };
static int arizona_validate_fll(struct arizona_fll *fll,
unsigned int Fref,
unsigned int Fout)
{
unsigned int Fvco_min;
if (Fref / ARIZONA_FLL_MAX_REFDIV > ARIZONA_FLL_MAX_FREF) {
arizona_fll_err(fll,
"Can't scale %dMHz in to <=13.5MHz\n",
Fref);
return -EINVAL;
}
Fvco_min = ARIZONA_FLL_MIN_FVCO * fll->vco_mult;
if (Fout * ARIZONA_FLL_MAX_OUTDIV < Fvco_min) {
arizona_fll_err(fll, "No FLL_OUTDIV for Fout=%uHz\n",
Fout);
return -EINVAL;
}
return 0;
}
static int arizona_calc_fll(struct arizona_fll *fll, static int arizona_calc_fll(struct arizona_fll *fll,
struct arizona_fll_cfg *cfg, struct arizona_fll_cfg *cfg,
unsigned int Fref, unsigned int Fref,
...@@ -1400,12 +1423,8 @@ static int arizona_calc_fll(struct arizona_fll *fll, ...@@ -1400,12 +1423,8 @@ static int arizona_calc_fll(struct arizona_fll *fll,
div *= 2; div *= 2;
cfg->refdiv++; cfg->refdiv++;
if (div > ARIZONA_FLL_MAX_REFDIV) { if (div > ARIZONA_FLL_MAX_REFDIV)
arizona_fll_err(fll,
"Can't scale %dMHz in to <=13.5MHz\n",
Fref);
return -EINVAL; return -EINVAL;
}
} }
/* Apply the division for our remaining calculations */ /* Apply the division for our remaining calculations */
...@@ -1415,11 +1434,8 @@ static int arizona_calc_fll(struct arizona_fll *fll, ...@@ -1415,11 +1434,8 @@ static int arizona_calc_fll(struct arizona_fll *fll,
div = ARIZONA_FLL_MIN_OUTDIV; div = ARIZONA_FLL_MIN_OUTDIV;
while (Fout * div < ARIZONA_FLL_MIN_FVCO * fll->vco_mult) { while (Fout * div < ARIZONA_FLL_MIN_FVCO * fll->vco_mult) {
div++; div++;
if (div > ARIZONA_FLL_MAX_OUTDIV) { if (div > ARIZONA_FLL_MAX_OUTDIV)
arizona_fll_err(fll, "No FLL_OUTDIV for Fout=%uHz\n",
Fout);
return -EINVAL; return -EINVAL;
}
} }
target = Fout * div / fll->vco_mult; target = Fout * div / fll->vco_mult;
cfg->outdiv = div; cfg->outdiv = div;
...@@ -1536,13 +1552,12 @@ static bool arizona_is_enabled_fll(struct arizona_fll *fll) ...@@ -1536,13 +1552,12 @@ static bool arizona_is_enabled_fll(struct arizona_fll *fll)
return reg & ARIZONA_FLL1_ENA; return reg & ARIZONA_FLL1_ENA;
} }
static void arizona_enable_fll(struct arizona_fll *fll, static void arizona_enable_fll(struct arizona_fll *fll)
struct arizona_fll_cfg *ref,
struct arizona_fll_cfg *sync)
{ {
struct arizona *arizona = fll->arizona; struct arizona *arizona = fll->arizona;
int ret; int ret;
bool use_sync = false; bool use_sync = false;
struct arizona_fll_cfg cfg;
/* /*
* If we have both REFCLK and SYNCCLK then enable both, * If we have both REFCLK and SYNCCLK then enable both,
...@@ -1550,15 +1565,21 @@ static void arizona_enable_fll(struct arizona_fll *fll, ...@@ -1550,15 +1565,21 @@ static void arizona_enable_fll(struct arizona_fll *fll,
*/ */
if (fll->ref_src >= 0 && fll->ref_freq && if (fll->ref_src >= 0 && fll->ref_freq &&
fll->ref_src != fll->sync_src) { fll->ref_src != fll->sync_src) {
arizona_apply_fll(arizona, fll->base, ref, fll->ref_src, arizona_calc_fll(fll, &cfg, fll->ref_freq, fll->fout);
arizona_apply_fll(arizona, fll->base, &cfg, fll->ref_src,
false); false);
if (fll->sync_src >= 0) { if (fll->sync_src >= 0) {
arizona_apply_fll(arizona, fll->base + 0x10, sync, arizona_calc_fll(fll, &cfg, fll->sync_freq, fll->fout);
arizona_apply_fll(arizona, fll->base + 0x10, &cfg,
fll->sync_src, true); fll->sync_src, true);
use_sync = true; use_sync = true;
} }
} else if (fll->sync_src >= 0) { } else if (fll->sync_src >= 0) {
arizona_apply_fll(arizona, fll->base, sync, arizona_calc_fll(fll, &cfg, fll->sync_freq, fll->fout);
arizona_apply_fll(arizona, fll->base, &cfg,
fll->sync_src, false); fll->sync_src, false);
regmap_update_bits_async(arizona->regmap, fll->base + 0x11, regmap_update_bits_async(arizona->regmap, fll->base + 0x11,
...@@ -1620,32 +1641,22 @@ static void arizona_disable_fll(struct arizona_fll *fll) ...@@ -1620,32 +1641,22 @@ static void arizona_disable_fll(struct arizona_fll *fll)
int arizona_set_fll_refclk(struct arizona_fll *fll, int source, int arizona_set_fll_refclk(struct arizona_fll *fll, int source,
unsigned int Fref, unsigned int Fout) unsigned int Fref, unsigned int Fout)
{ {
struct arizona_fll_cfg ref, sync;
int ret; int ret;
if (fll->ref_src == source && fll->ref_freq == Fref) if (fll->ref_src == source && fll->ref_freq == Fref)
return 0; return 0;
if (fll->fout) { if (fll->fout && Fref > 0) {
if (Fref > 0) { ret = arizona_validate_fll(fll, Fref, fll->fout);
ret = arizona_calc_fll(fll, &ref, Fref, fll->fout); if (ret != 0)
if (ret != 0) return ret;
return ret;
}
if (fll->sync_src >= 0) {
ret = arizona_calc_fll(fll, &sync, fll->sync_freq,
fll->fout);
if (ret != 0)
return ret;
}
} }
fll->ref_src = source; fll->ref_src = source;
fll->ref_freq = Fref; fll->ref_freq = Fref;
if (fll->fout && Fref > 0) { if (fll->fout && Fref > 0) {
arizona_enable_fll(fll, &ref, &sync); arizona_enable_fll(fll);
} }
return 0; return 0;
...@@ -1655,7 +1666,6 @@ EXPORT_SYMBOL_GPL(arizona_set_fll_refclk); ...@@ -1655,7 +1666,6 @@ EXPORT_SYMBOL_GPL(arizona_set_fll_refclk);
int arizona_set_fll(struct arizona_fll *fll, int source, int arizona_set_fll(struct arizona_fll *fll, int source,
unsigned int Fref, unsigned int Fout) unsigned int Fref, unsigned int Fout)
{ {
struct arizona_fll_cfg ref, sync;
int ret; int ret;
if (fll->sync_src == source && if (fll->sync_src == source &&
...@@ -1664,13 +1674,12 @@ int arizona_set_fll(struct arizona_fll *fll, int source, ...@@ -1664,13 +1674,12 @@ int arizona_set_fll(struct arizona_fll *fll, int source,
if (Fout) { if (Fout) {
if (fll->ref_src >= 0) { if (fll->ref_src >= 0) {
ret = arizona_calc_fll(fll, &ref, fll->ref_freq, ret = arizona_validate_fll(fll, fll->ref_freq, Fout);
Fout);
if (ret != 0) if (ret != 0)
return ret; return ret;
} }
ret = arizona_calc_fll(fll, &sync, Fref, Fout); ret = arizona_validate_fll(fll, Fref, Fout);
if (ret != 0) if (ret != 0)
return ret; return ret;
} }
...@@ -1680,7 +1689,7 @@ int arizona_set_fll(struct arizona_fll *fll, int source, ...@@ -1680,7 +1689,7 @@ int arizona_set_fll(struct arizona_fll *fll, int source,
fll->fout = Fout; fll->fout = Fout;
if (Fout) { if (Fout) {
arizona_enable_fll(fll, &ref, &sync); arizona_enable_fll(fll);
} else { } else {
arizona_disable_fll(fll); arizona_disable_fll(fll);
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment