ASoC: arizona: Factor out check for enabled FLL
In preparation for additional features on the FLL this patch factors out the code which checks if an FLL is currently enabled into a seperate function. Signed-off-by: Charles Keepax <ckeepax@opensource.wolfsonmicro.com> Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
This commit is contained in:
parent
9e359c645f
commit
d122d6c974
|
@ -1074,12 +1074,27 @@ static void arizona_apply_fll(struct arizona *arizona, unsigned int base,
|
||||||
ARIZONA_FLL1_CTRL_UPD | cfg->n);
|
ARIZONA_FLL1_CTRL_UPD | cfg->n);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static bool arizona_is_enabled_fll(struct arizona_fll *fll)
|
||||||
|
{
|
||||||
|
struct arizona *arizona = fll->arizona;
|
||||||
|
unsigned int reg;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
ret = regmap_read(arizona->regmap, fll->base + 1, ®);
|
||||||
|
if (ret != 0) {
|
||||||
|
arizona_fll_err(fll, "Failed to read current state: %d\n",
|
||||||
|
ret);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
return reg & ARIZONA_FLL1_ENA;
|
||||||
|
}
|
||||||
|
|
||||||
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 *arizona = fll->arizona;
|
struct arizona *arizona = fll->arizona;
|
||||||
struct arizona_fll_cfg ref, sync;
|
struct arizona_fll_cfg ref, sync;
|
||||||
unsigned int reg;
|
|
||||||
bool ena;
|
bool ena;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
|
@ -1111,13 +1126,7 @@ int arizona_set_fll(struct arizona_fll *fll, int source,
|
||||||
fll->sync_freq = Fref;
|
fll->sync_freq = Fref;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = regmap_read(arizona->regmap, fll->base + 1, ®);
|
ena = arizona_is_enabled_fll(fll);
|
||||||
if (ret != 0) {
|
|
||||||
arizona_fll_err(fll, "Failed to read current state: %d\n",
|
|
||||||
ret);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
ena = reg & ARIZONA_FLL1_ENA;
|
|
||||||
|
|
||||||
if (Fout) {
|
if (Fout) {
|
||||||
regmap_update_bits(arizona->regmap, fll->base + 5,
|
regmap_update_bits(arizona->regmap, fll->base + 5,
|
||||||
|
|
Loading…
Reference in New Issue