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

Commit 43fa2f6b authored by Chen-Yu Tsai's avatar Chen-Yu Tsai Committed by Greg Kroah-Hartman
Browse files

pinctrl: mediatek: paris: Rework mtk_pinconf_{get,set} switch/case logic 



[ Upstream commit 9b780fa1ff14663c2e0f07ad098b96b8337f27a4 ]

The current code deals with optional features by testing for the
function pointers and returning -ENOTSUPP if it is not valid. This is
done for multiple pin config settings and results in the code that
handles the supporting cases to get indented by one level. This is
aggrevated by the fact that some features require another level of
conditionals.

Instead of assigning the same error code in all unsupported optional
feature cases, simply have that error code as the default, and break
out of the switch/case block whenever a feature is unsupported, or an
error is returned. This reduces indentation by one level for the useful
code.

Also replace the goto statements with break statements. The result is
the same, as the gotos simply exit the switch/case block, which can
also be achieved with a break statement. With the latter the intent
is clear and easier to understand.

Signed-off-by: default avatarChen-Yu Tsai <wenst@chromium.org>
Reviewed-by: default avatarAngeloGioacchino Del Regno <angelogioacchino.delregno@collabora.com>
Link: https://lore.kernel.org/r/20220308100956.2750295-8-wenst@chromium.org


Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
Stable-dep-of: c5d3b64c568a ("pinctrl: mediatek: paris: Rework support for PIN_CONFIG_{INPUT,OUTPUT}_ENABLE")
Signed-off-by: default avatarSasha Levin <sashal@kernel.org>
parent 8840d7ff

drivers/pinctrl/mediatek/pinctrl-paris.c

+61 −83
Original line number Diff line number Diff line
@@ -78,23 +78,23 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, 
{

	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);

	u32 param = pinconf_to_config_param(*config);

	int pullup, err, reg, ret = 1;

	int pullup, reg, err = -ENOTSUPP, ret = 1;

	const struct mtk_pin_desc *desc;



	if (pin >= hw->soc->npins) {

		err = -EINVAL;

		goto out;

	}

	if (pin >= hw->soc->npins)

		return -EINVAL;



	desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin];



	switch (param) {

	case PIN_CONFIG_BIAS_DISABLE:

	case PIN_CONFIG_BIAS_PULL_UP:

	case PIN_CONFIG_BIAS_PULL_DOWN:

		if (hw->soc->bias_get_combo) {

		if (!hw->soc->bias_get_combo)

			break;

		err = hw->soc->bias_get_combo(hw, desc, &pullup, &ret);

		if (err)

				goto out;

			break;

		if (ret == MTK_PUPD_SET_R1R0_00)

			ret = MTK_DISABLE;

		if (param == PIN_CONFIG_BIAS_DISABLE) {
@@ -107,9 +107,6 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, 
			if (pullup || ret == MTK_DISABLE)

				err = -EINVAL;

		}

		} else {

			err = -ENOTSUPP;

		}

		break;

	case PIN_CONFIG_SLEW_RATE:

		err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_SR, &ret);
@@ -118,7 +115,7 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, 
	case PIN_CONFIG_OUTPUT_ENABLE:

		err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &ret);

		if (err)

			goto out;

			break;

		/*     CONFIG     Current direction return value

		 * -------------  ----------------- ----------------------

		 * OUTPUT_ENABLE       output       1 (= HW value)
@@ -133,23 +130,21 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, 
	case PIN_CONFIG_INPUT_SCHMITT_ENABLE:

		err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &ret);

		if (err)

			goto out;

			break;

		/* return error when in output mode

		 * because schmitt trigger only work in input mode

		 */

		if (ret) {

			err = -EINVAL;

			goto out;

			break;

		}



		err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_SMT, &ret);



		break;

	case PIN_CONFIG_DRIVE_STRENGTH:

		if (hw->soc->drive_get)

		if (!hw->soc->drive_get)

			break;

		err = hw->soc->drive_get(hw, desc, &ret);

		else

			err = -ENOTSUPP;

		break;

	case MTK_PIN_CONFIG_TDSEL:

	case MTK_PIN_CONFIG_RDSEL:
@@ -159,23 +154,18 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, 
		break;

	case MTK_PIN_CONFIG_PU_ADV:

	case MTK_PIN_CONFIG_PD_ADV:

		if (hw->soc->adv_pull_get) {

		if (!hw->soc->adv_pull_get)

			break;

		pullup = param == MTK_PIN_CONFIG_PU_ADV;

		err = hw->soc->adv_pull_get(hw, desc, pullup, &ret);

		} else

			err = -ENOTSUPP;

		break;

	case MTK_PIN_CONFIG_DRV_ADV:

		if (hw->soc->adv_drive_get)

		if (!hw->soc->adv_drive_get)

			break;

		err = hw->soc->adv_drive_get(hw, desc, &ret);

		else

			err = -ENOTSUPP;

		break;

	default:

		err = -ENOTSUPP;

	}



out:

	if (!err)

		*config = pinconf_to_config_packed(param, ret);
@@ -187,33 +177,29 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, 
{

	struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);

	const struct mtk_pin_desc *desc;

	int err = 0;

	int err = -ENOTSUPP;

	u32 reg;



	if (pin >= hw->soc->npins) {

		err = -EINVAL;

		goto err;

	}

	if (pin >= hw->soc->npins)

		return -EINVAL;



	desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin];



	switch ((u32)param) {

	case PIN_CONFIG_BIAS_DISABLE:

		if (hw->soc->bias_set_combo)

		if (!hw->soc->bias_set_combo)

			break;

		err = hw->soc->bias_set_combo(hw, desc, 0, MTK_DISABLE);

		else

			err = -ENOTSUPP;

		break;

	case PIN_CONFIG_BIAS_PULL_UP:

		if (hw->soc->bias_set_combo)

		if (!hw->soc->bias_set_combo)

			break;

		err = hw->soc->bias_set_combo(hw, desc, 1, arg);

		else

			err = -ENOTSUPP;

		break;

	case PIN_CONFIG_BIAS_PULL_DOWN:

		if (hw->soc->bias_set_combo)

		if (!hw->soc->bias_set_combo)

			break;

		err = hw->soc->bias_set_combo(hw, desc, 0, arg);

		else

			err = -ENOTSUPP;

		break;

	case PIN_CONFIG_OUTPUT_ENABLE:

		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT,
@@ -222,7 +208,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, 
		 *  does not have SMT control

		 */

		if (err != -ENOTSUPP)

			goto err;

			break;



		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,

				       MTK_OUTPUT);
@@ -231,7 +217,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, 
		/* regard all non-zero value as enable */

		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_IES, !!arg);

		if (err)

			goto err;

			break;



		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,

				       MTK_INPUT);
@@ -244,7 +230,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, 
		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,

				       MTK_OUTPUT);

		if (err)

			goto err;

			break;



		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DO,

				       arg);
@@ -256,15 +242,14 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, 
		 */

		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, !arg);

		if (err)

			goto err;

			break;



		err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT, !!arg);

		break;

	case PIN_CONFIG_DRIVE_STRENGTH:

		if (hw->soc->drive_set)

		if (!hw->soc->drive_set)

			break;

		err = hw->soc->drive_set(hw, desc, arg);

		else

			err = -ENOTSUPP;

		break;

	case MTK_PIN_CONFIG_TDSEL:

	case MTK_PIN_CONFIG_RDSEL:
@@ -274,26 +259,19 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, 
		break;

	case MTK_PIN_CONFIG_PU_ADV:

	case MTK_PIN_CONFIG_PD_ADV:

		if (hw->soc->adv_pull_set) {

			bool pullup;



			pullup = param == MTK_PIN_CONFIG_PU_ADV;

			err = hw->soc->adv_pull_set(hw, desc, pullup,

		if (!hw->soc->adv_pull_set)

			break;

		err = hw->soc->adv_pull_set(hw, desc,

					    (param == MTK_PIN_CONFIG_PU_ADV),

					    arg);

		} else

			err = -ENOTSUPP;

		break;

	case MTK_PIN_CONFIG_DRV_ADV:

		if (hw->soc->adv_drive_set)

		if (!hw->soc->adv_drive_set)

			break;

		err = hw->soc->adv_drive_set(hw, desc, arg);

		else

			err = -ENOTSUPP;

		break;

	default:

		err = -ENOTSUPP;

	}



err:

	return err;

}