mfd: arizona: Fix formating/style issues in arizona_apply_hardware_patch
In preparation for some refactoring fixup some minor style, formating and code clarity issues. Signed-off-by: Charles Keepax <ckeepax@opensource.wolfsonmicro.com> Signed-off-by: Lee Jones <lee.jones@linaro.org>
This commit is contained in:
parent
1c1c6bba57
commit
0be068a077
@ -264,20 +264,20 @@ static void arizona_disable_reset(struct arizona *arizona)
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
static int arizona_apply_hardware_patch(struct arizona* arizona)
|
static int wm5102_apply_hardware_patch(struct arizona *arizona)
|
||||||
{
|
{
|
||||||
unsigned int fll, sysclk;
|
unsigned int fll, sysclk;
|
||||||
int ret, err;
|
int ret, err;
|
||||||
|
|
||||||
/* Cache existing FLL and SYSCLK settings */
|
/* Cache existing FLL and SYSCLK settings */
|
||||||
ret = regmap_read(arizona->regmap, ARIZONA_FLL1_CONTROL_1, &fll);
|
ret = regmap_read(arizona->regmap, ARIZONA_FLL1_CONTROL_1, &fll);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
dev_err(arizona->dev, "Failed to cache FLL settings: %d\n",
|
dev_err(arizona->dev, "Failed to cache FLL settings: %d\n",
|
||||||
ret);
|
ret);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
ret = regmap_read(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, &sysclk);
|
ret = regmap_read(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, &sysclk);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
dev_err(arizona->dev, "Failed to cache SYSCLK settings: %d\n",
|
dev_err(arizona->dev, "Failed to cache SYSCLK settings: %d\n",
|
||||||
ret);
|
ret);
|
||||||
return ret;
|
return ret;
|
||||||
@ -286,7 +286,7 @@ static int arizona_apply_hardware_patch(struct arizona* arizona)
|
|||||||
/* Start up SYSCLK using the FLL in free running mode */
|
/* Start up SYSCLK using the FLL in free running mode */
|
||||||
ret = regmap_write(arizona->regmap, ARIZONA_FLL1_CONTROL_1,
|
ret = regmap_write(arizona->regmap, ARIZONA_FLL1_CONTROL_1,
|
||||||
ARIZONA_FLL1_ENA | ARIZONA_FLL1_FREERUN);
|
ARIZONA_FLL1_ENA | ARIZONA_FLL1_FREERUN);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
dev_err(arizona->dev,
|
dev_err(arizona->dev,
|
||||||
"Failed to start FLL in freerunning mode: %d\n",
|
"Failed to start FLL in freerunning mode: %d\n",
|
||||||
ret);
|
ret);
|
||||||
@ -295,36 +295,36 @@ static int arizona_apply_hardware_patch(struct arizona* arizona)
|
|||||||
ret = arizona_poll_reg(arizona, 25, ARIZONA_INTERRUPT_RAW_STATUS_5,
|
ret = arizona_poll_reg(arizona, 25, ARIZONA_INTERRUPT_RAW_STATUS_5,
|
||||||
ARIZONA_FLL1_CLOCK_OK_STS,
|
ARIZONA_FLL1_CLOCK_OK_STS,
|
||||||
ARIZONA_FLL1_CLOCK_OK_STS);
|
ARIZONA_FLL1_CLOCK_OK_STS);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
ret = -ETIMEDOUT;
|
ret = -ETIMEDOUT;
|
||||||
goto err_fll;
|
goto err_fll;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = regmap_write(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, 0x0144);
|
ret = regmap_write(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, 0x0144);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
dev_err(arizona->dev, "Failed to start SYSCLK: %d\n", ret);
|
dev_err(arizona->dev, "Failed to start SYSCLK: %d\n", ret);
|
||||||
goto err_fll;
|
goto err_fll;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Start the write sequencer and wait for it to finish */
|
/* Start the write sequencer and wait for it to finish */
|
||||||
ret = regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_0,
|
ret = regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_0,
|
||||||
ARIZONA_WSEQ_ENA | ARIZONA_WSEQ_START | 160);
|
ARIZONA_WSEQ_ENA | ARIZONA_WSEQ_START | 160);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
dev_err(arizona->dev, "Failed to start write sequencer: %d\n",
|
dev_err(arizona->dev, "Failed to start write sequencer: %d\n",
|
||||||
ret);
|
ret);
|
||||||
goto err_sysclk;
|
goto err_sysclk;
|
||||||
}
|
}
|
||||||
ret = arizona_poll_reg(arizona, 5, ARIZONA_WRITE_SEQUENCER_CTRL_1,
|
ret = arizona_poll_reg(arizona, 5, ARIZONA_WRITE_SEQUENCER_CTRL_1,
|
||||||
ARIZONA_WSEQ_BUSY, 0);
|
ARIZONA_WSEQ_BUSY, 0);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_0,
|
regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_0,
|
||||||
ARIZONA_WSEQ_ABORT);
|
ARIZONA_WSEQ_ABORT);
|
||||||
ret = -ETIMEDOUT;
|
ret = -ETIMEDOUT;
|
||||||
}
|
}
|
||||||
|
|
||||||
err_sysclk:
|
err_sysclk:
|
||||||
err = regmap_write(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, sysclk);
|
err = regmap_write(arizona->regmap, ARIZONA_SYSTEM_CLOCK_1, sysclk);
|
||||||
if (err != 0) {
|
if (err) {
|
||||||
dev_err(arizona->dev,
|
dev_err(arizona->dev,
|
||||||
"Failed to re-apply old SYSCLK settings: %d\n",
|
"Failed to re-apply old SYSCLK settings: %d\n",
|
||||||
err);
|
err);
|
||||||
@ -332,16 +332,13 @@ err_sysclk:
|
|||||||
|
|
||||||
err_fll:
|
err_fll:
|
||||||
err = regmap_write(arizona->regmap, ARIZONA_FLL1_CONTROL_1, fll);
|
err = regmap_write(arizona->regmap, ARIZONA_FLL1_CONTROL_1, fll);
|
||||||
if (err != 0) {
|
if (err) {
|
||||||
dev_err(arizona->dev,
|
dev_err(arizona->dev,
|
||||||
"Failed to re-apply old FLL settings: %d\n",
|
"Failed to re-apply old FLL settings: %d\n",
|
||||||
err);
|
err);
|
||||||
}
|
}
|
||||||
|
|
||||||
if (ret != 0)
|
return ret ?: err;
|
||||||
return ret;
|
|
||||||
else
|
|
||||||
return err;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int wm5102_clear_write_sequencer(struct arizona *arizona)
|
static int wm5102_clear_write_sequencer(struct arizona *arizona)
|
||||||
@ -407,8 +404,8 @@ static int arizona_runtime_resume(struct device *dev)
|
|||||||
goto err;
|
goto err;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = arizona_apply_hardware_patch(arizona);
|
ret = wm5102_apply_hardware_patch(arizona);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
dev_err(arizona->dev,
|
dev_err(arizona->dev,
|
||||||
"Failed to apply hardware patch: %d\n",
|
"Failed to apply hardware patch: %d\n",
|
||||||
ret);
|
ret);
|
||||||
@ -924,8 +921,8 @@ int arizona_dev_init(struct arizona *arizona)
|
|||||||
|
|
||||||
switch (arizona->type) {
|
switch (arizona->type) {
|
||||||
case WM5102:
|
case WM5102:
|
||||||
ret = arizona_apply_hardware_patch(arizona);
|
ret = wm5102_apply_hardware_patch(arizona);
|
||||||
if (ret != 0) {
|
if (ret) {
|
||||||
dev_err(arizona->dev,
|
dev_err(arizona->dev,
|
||||||
"Failed to apply hardware patch: %d\n",
|
"Failed to apply hardware patch: %d\n",
|
||||||
ret);
|
ret);
|
||||||
|
Loading…
Reference in New Issue
Block a user