Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit f04adc5a authored by Axel Lin's avatar Axel Lin Committed by Mark Brown
Browse files

regulator: ab8500: Don't update info->update_val if write to register fails



This patch ensures info->update_val is consistent with current register value.

Signed-off-by: default avatarAxel Lin <axel.lin@ingics.com>
Acked-by: default avatarBengt Jonsson <bengt.g.jonsson@stericsson.com>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent 241896ce
Loading
Loading
Loading
Loading
+11 −9
Original line number Diff line number Diff line
@@ -392,9 +392,8 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev,
			val = info->mode_val_idle;
			break;
		default:
			if (info->shared_mode)
				mutex_unlock(&shared_mode_mutex);
			return -EINVAL;
			ret = -EINVAL;
			goto out_unlock;
		}

		bank = info->mode_bank;
@@ -405,17 +404,14 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev,

		switch (mode) {
		case REGULATOR_MODE_NORMAL:
			info->update_val = info->update_val_normal;
			val = info->update_val_normal;
			break;
		case REGULATOR_MODE_IDLE:
			info->update_val = info->update_val_idle;
			val = info->update_val_idle;
			break;
		default:
			if (info->shared_mode)
				mutex_unlock(&shared_mode_mutex);
			return -EINVAL;
			ret = -EINVAL;
			goto out_unlock;
		}

		bank = info->update_bank;
@@ -426,9 +422,11 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev,
	if (dmr || ab8500_regulator_is_enabled(rdev)) {
		ret = abx500_mask_and_set_register_interruptible(info->dev,
			bank, reg, mask, val);
		if (ret < 0)
		if (ret < 0) {
			dev_err(rdev_get_dev(rdev),
				"couldn't set regulator mode\n");
			goto out_unlock;
		}

		dev_vdbg(rdev_get_dev(rdev),
			"%s-set_mode (bank, reg, mask, value): "
@@ -437,6 +435,10 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev,
			mask, val);
	}

	if (!dmr)
		info->update_val = val;

out_unlock:
	if (info->shared_mode)
		mutex_unlock(&shared_mode_mutex);