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

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

regulator: ab8500: Don't update lp_mode_req flag in set_mode() error paths 



Currently, set invalid mode setting for shared mode regulators may change
sm->lp_mode_req flag. This patch ensures we don't set lp_mode_req flag to wrong
status if set_mode() fails.

This patch includes some clean up, and these changes makes this patch looks like
code refactor. The clean up is mainly to avoid adding ugly code to handle
failure paths.

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 f04adc5a

drivers/regulator/ab8500.c

+43 −55
Original line number Original line Diff line number Diff line
@@ -348,11 +348,8 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev, 
				     unsigned int mode)

				     unsigned int mode)

{

{

	int ret = 0;

	int ret = 0;

	u8 bank;

	u8 bank, reg, mask, val;

	u8 reg;

	bool lp_mode_req = false;

	u8 mask;

	u8 val;

	bool dmr = false; /* Dedicated mode register */

	struct ab8500_regulator_info *info = rdev_get_drvdata(rdev);

	struct ab8500_regulator_info *info = rdev_get_drvdata(rdev);





	if (info == NULL) {

	if (info == NULL) {
@@ -360,53 +357,46 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev, 
		return -EINVAL;

		return -EINVAL;

	}

	}





	if (info->shared_mode) {

	if (info->mode_mask) {

		/*

		bank = info->mode_bank;

		 * Special case where mode is shared between two regulators.

		reg = info->mode_reg;

		 */

		mask = info->mode_mask;

		struct ab8500_shared_mode *sm = info->shared_mode;

		mutex_lock(&shared_mode_mutex);



		if (mode == REGULATOR_MODE_IDLE) {

			sm->lp_mode_req = true; /* Low power mode requested */

			if (!((sm->shared_regulator)->

			      shared_mode->lp_mode_req)) {

				mutex_unlock(&shared_mode_mutex);

				return 0; /* Other regulator prevent LP mode */

			}

	} else {

	} else {

			sm->lp_mode_req = false;

		bank = info->update_bank;

		}

		reg = info->update_reg;

		mask = info->update_mask;

	}

	}





	if (info->mode_mask) {

	if (info->shared_mode)

		/* Dedicated register for handling mode */

		mutex_lock(&shared_mode_mutex);



		dmr = true;





	switch (mode) {

	switch (mode) {

	case REGULATOR_MODE_NORMAL:

	case REGULATOR_MODE_NORMAL:

		if (info->shared_mode)

			lp_mode_req = false;



		if (info->mode_mask)

			val = info->mode_val_normal;

			val = info->mode_val_normal;

		else

			val = info->update_val_normal;

		break;

		break;

	case REGULATOR_MODE_IDLE:

	case REGULATOR_MODE_IDLE:

			val = info->mode_val_idle;

		if (info->shared_mode) {

			break;

			struct ab8500_regulator_info *shared_regulator;

		default:



			ret = -EINVAL;

			shared_regulator = info->shared_mode->shared_regulator;

			if (!shared_regulator->shared_mode->lp_mode_req) {

				/* Other regulator prevent LP mode */

				info->shared_mode->lp_mode_req = true;

				goto out_unlock;

				goto out_unlock;

			}

			}





		bank = info->mode_bank;

			lp_mode_req = true;

		reg = info->mode_reg;

		}

		mask = info->mode_mask;

	} else {

		/* Mode register same as enable register */





		switch (mode) {

		if (info->mode_mask)

		case REGULATOR_MODE_NORMAL:

			val = info->mode_val_idle;

			val = info->update_val_normal;

		else

			break;

		case REGULATOR_MODE_IDLE:

			val = info->update_val_idle;

			val = info->update_val_idle;

		break;

		break;

	default:

	default:
@@ -414,12 +404,7 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev, 
		goto out_unlock;

		goto out_unlock;

	}

	}





		bank = info->update_bank;

	if (info->mode_mask || ab8500_regulator_is_enabled(rdev)) {

		reg = info->update_reg;

		mask = info->update_mask;

	}



	if (dmr || ab8500_regulator_is_enabled(rdev)) {

		ret = abx500_mask_and_set_register_interruptible(info->dev,

		ret = abx500_mask_and_set_register_interruptible(info->dev,

			bank, reg, mask, val);

			bank, reg, mask, val);

		if (ret < 0) {

		if (ret < 0) {
@@ -435,9 +420,12 @@ static int ab8500_regulator_set_mode(struct regulator_dev *rdev, 
			mask, val);

			mask, val);

	}

	}





	if (!dmr)

	if (!info->mode_mask)

		info->update_val = val;

		info->update_val = val;





	if (info->shared_mode)

		info->shared_mode->lp_mode_req = lp_mode_req;



out_unlock:

out_unlock:

	if (info->shared_mode)

	if (info->shared_mode)

		mutex_unlock(&shared_mode_mutex);

		mutex_unlock(&shared_mode_mutex);