regulator: ab8500: Update info->update_val only when successfully update register
Don't update info->update_val if write to the register fails. Signed-off-by: Axel Lin <axel.lin@ingics.com> Acked-by: Bengt Jonsson <bengt.g.jonsson@stericsson.com> Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
This commit is contained in:
parent
da0b0c47dc
commit
742a73259d
1 changed files with 19 additions and 8 deletions
|
@ -184,8 +184,8 @@ static unsigned int ab8500_regulator_get_optimum_mode(
|
||||||
static int ab8500_regulator_set_mode(struct regulator_dev *rdev,
|
static int ab8500_regulator_set_mode(struct regulator_dev *rdev,
|
||||||
unsigned int mode)
|
unsigned int mode)
|
||||||
{
|
{
|
||||||
int ret = 0;
|
int ret;
|
||||||
|
u8 update_val;
|
||||||
struct ab8500_regulator_info *info = rdev_get_drvdata(rdev);
|
struct ab8500_regulator_info *info = rdev_get_drvdata(rdev);
|
||||||
|
|
||||||
if (info == NULL) {
|
if (info == NULL) {
|
||||||
|
@ -195,31 +195,42 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev,
|
||||||
|
|
||||||
switch (mode) {
|
switch (mode) {
|
||||||
case REGULATOR_MODE_NORMAL:
|
case REGULATOR_MODE_NORMAL:
|
||||||
info->update_val = info->update_val_normal;
|
update_val = info->update_val_normal;
|
||||||
break;
|
break;
|
||||||
case REGULATOR_MODE_IDLE:
|
case REGULATOR_MODE_IDLE:
|
||||||
info->update_val = info->update_val_idle;
|
update_val = info->update_val_idle;
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* ab8500 regulators share mode and enable in the same register bits.
|
||||||
|
off = 0b00
|
||||||
|
low power mode= 0b11
|
||||||
|
full powermode = 0b01
|
||||||
|
(HW control mode = 0b10)
|
||||||
|
Thus we don't write to the register when regulator is disabled.
|
||||||
|
*/
|
||||||
if (info->is_enabled) {
|
if (info->is_enabled) {
|
||||||
ret = abx500_mask_and_set_register_interruptible(info->dev,
|
ret = abx500_mask_and_set_register_interruptible(info->dev,
|
||||||
info->update_bank, info->update_reg,
|
info->update_bank, info->update_reg,
|
||||||
info->update_mask, info->update_val);
|
info->update_mask, update_val);
|
||||||
if (ret < 0)
|
if (ret < 0) {
|
||||||
dev_err(rdev_get_dev(rdev),
|
dev_err(rdev_get_dev(rdev),
|
||||||
"couldn't set regulator mode\n");
|
"couldn't set regulator mode\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
dev_vdbg(rdev_get_dev(rdev),
|
dev_vdbg(rdev_get_dev(rdev),
|
||||||
"%s-set_mode (bank, reg, mask, value): "
|
"%s-set_mode (bank, reg, mask, value): "
|
||||||
"0x%x, 0x%x, 0x%x, 0x%x\n",
|
"0x%x, 0x%x, 0x%x, 0x%x\n",
|
||||||
info->desc.name, info->update_bank, info->update_reg,
|
info->desc.name, info->update_bank, info->update_reg,
|
||||||
info->update_mask, info->update_val);
|
info->update_mask, update_val);
|
||||||
}
|
}
|
||||||
|
|
||||||
return ret;
|
info->update_val = update_val;
|
||||||
|
|
||||||
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static unsigned int ab8500_regulator_get_mode(struct regulator_dev *rdev)
|
static unsigned int ab8500_regulator_get_mode(struct regulator_dev *rdev)
|
||||||
|
|
Loading…
Add table
Reference in a new issue