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:
Charles Keepax 2015-05-11 13:58:04 +01:00 committed by Lee Jones
parent 1c1c6bba57
commit 0be068a077

View File

@ -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);