Commit ef84f885 authored by Charles Keepax's avatar Charles Keepax Committed by Lee Jones

mfd: arizona: Refactor arizona_poll_reg

Currently, we specify the timeout in terms of the number of polls but it
is more clear from a user of the functions perspective to specify the
timeout directly in milliseconds, as such update the function to these new
semantics.

Additionally, arizona_poll_reg essentially hard-codes
regmap_read_poll_timeout, update the implementation to use
regmap_read_poll_timeout. We still keep arizona_poll_reg around as
regmap_read_poll_timeout is a macro so rather than expand this for each
caller keep it wrapped in arizona_poll_reg.

Whilst we are doing this make the timeouts a little more generous as
the previous system had a bit more slack as it was done as a delay per
iteration of the loop whereas regmap_read_poll_timeout compares ktime's.
Signed-off-by: default avatarCharles Keepax <ckeepax@opensource.wolfsonmicro.com>
Signed-off-by: default avatarLee Jones <lee.jones@linaro.org>
parent f9657b8f
...@@ -235,29 +235,25 @@ static irqreturn_t arizona_overclocked(int irq, void *data) ...@@ -235,29 +235,25 @@ static irqreturn_t arizona_overclocked(int irq, void *data)
return IRQ_HANDLED; return IRQ_HANDLED;
} }
#define ARIZONA_REG_POLL_DELAY_US 7500
static int arizona_poll_reg(struct arizona *arizona, static int arizona_poll_reg(struct arizona *arizona,
int timeout, unsigned int reg, int timeout_ms, unsigned int reg,
unsigned int mask, unsigned int target) unsigned int mask, unsigned int target)
{ {
unsigned int val = 0; unsigned int val = 0;
int ret, i; int ret;
for (i = 0; i < timeout; i++) {
ret = regmap_read(arizona->regmap, reg, &val);
if (ret != 0) {
dev_err(arizona->dev, "Failed to read reg 0x%x: %d\n",
reg, ret);
continue;
}
if ((val & mask) == target)
return 0;
usleep_range(1000, 5000); ret = regmap_read_poll_timeout(arizona->regmap,
} ARIZONA_INTERRUPT_RAW_STATUS_5, val,
((val & mask) == target),
ARIZONA_REG_POLL_DELAY_US,
timeout_ms * 1000);
if (ret)
dev_err(arizona->dev, "Polling reg 0x%x timed out: %x\n",
reg, val);
dev_err(arizona->dev, "Polling reg 0x%x timed out: %x\n", reg, val); return ret;
return -ETIMEDOUT;
} }
static int arizona_wait_for_boot(struct arizona *arizona) static int arizona_wait_for_boot(struct arizona *arizona)
...@@ -269,7 +265,7 @@ static int arizona_wait_for_boot(struct arizona *arizona) ...@@ -269,7 +265,7 @@ static int arizona_wait_for_boot(struct arizona *arizona)
* we won't race with the interrupt handler as it'll be blocked on * we won't race with the interrupt handler as it'll be blocked on
* runtime resume. * runtime resume.
*/ */
ret = arizona_poll_reg(arizona, 5, ARIZONA_INTERRUPT_RAW_STATUS_5, ret = arizona_poll_reg(arizona, 30, ARIZONA_INTERRUPT_RAW_STATUS_5,
ARIZONA_BOOT_DONE_STS, ARIZONA_BOOT_DONE_STS); ARIZONA_BOOT_DONE_STS, ARIZONA_BOOT_DONE_STS);
if (!ret) if (!ret)
...@@ -339,7 +335,7 @@ static int arizona_enable_freerun_sysclk(struct arizona *arizona, ...@@ -339,7 +335,7 @@ static int arizona_enable_freerun_sysclk(struct arizona *arizona,
ret); ret);
return ret; return ret;
} }
ret = arizona_poll_reg(arizona, 25, ARIZONA_INTERRUPT_RAW_STATUS_5, ret = arizona_poll_reg(arizona, 180, 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) if (ret)
...@@ -403,7 +399,7 @@ static int wm5102_apply_hardware_patch(struct arizona *arizona) ...@@ -403,7 +399,7 @@ static int wm5102_apply_hardware_patch(struct arizona *arizona)
goto err; goto err;
} }
ret = arizona_poll_reg(arizona, 5, ARIZONA_WRITE_SEQUENCER_CTRL_1, ret = arizona_poll_reg(arizona, 30, ARIZONA_WRITE_SEQUENCER_CTRL_1,
ARIZONA_WSEQ_BUSY, 0); ARIZONA_WSEQ_BUSY, 0);
if (ret) if (ret)
regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_0, regmap_write(arizona->regmap, ARIZONA_WRITE_SEQUENCER_CTRL_0,
......
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