Commit 9b780fa1 authored by Chen-Yu Tsai's avatar Chen-Yu Tsai Committed by Linus Walleij

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

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.orgSigned-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
parent 1763933d
...@@ -79,37 +79,34 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, ...@@ -79,37 +79,34 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev,
{ {
struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev); struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
u32 param = pinconf_to_config_param(*config); 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; const struct mtk_pin_desc *desc;
if (pin >= hw->soc->npins) { if (pin >= hw->soc->npins)
err = -EINVAL; return -EINVAL;
goto out;
}
desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin]; desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin];
switch (param) { switch (param) {
case PIN_CONFIG_BIAS_DISABLE: case PIN_CONFIG_BIAS_DISABLE:
case PIN_CONFIG_BIAS_PULL_UP: case PIN_CONFIG_BIAS_PULL_UP:
case PIN_CONFIG_BIAS_PULL_DOWN: case PIN_CONFIG_BIAS_PULL_DOWN:
if (hw->soc->bias_get_combo) { if (!hw->soc->bias_get_combo)
err = hw->soc->bias_get_combo(hw, desc, &pullup, &ret); break;
if (err) err = hw->soc->bias_get_combo(hw, desc, &pullup, &ret);
goto out; if (err)
if (ret == MTK_PUPD_SET_R1R0_00) break;
ret = MTK_DISABLE; if (ret == MTK_PUPD_SET_R1R0_00)
if (param == PIN_CONFIG_BIAS_DISABLE) { ret = MTK_DISABLE;
if (ret != MTK_DISABLE) if (param == PIN_CONFIG_BIAS_DISABLE) {
err = -EINVAL; if (ret != MTK_DISABLE)
} else if (param == PIN_CONFIG_BIAS_PULL_UP) { err = -EINVAL;
if (!pullup || ret == MTK_DISABLE) } else if (param == PIN_CONFIG_BIAS_PULL_UP) {
err = -EINVAL; if (!pullup || ret == MTK_DISABLE)
} else if (param == PIN_CONFIG_BIAS_PULL_DOWN) { err = -EINVAL;
if (pullup || ret == MTK_DISABLE) } else if (param == PIN_CONFIG_BIAS_PULL_DOWN) {
err = -EINVAL; if (pullup || ret == MTK_DISABLE)
} err = -EINVAL;
} else {
err = -ENOTSUPP;
} }
break; break;
case PIN_CONFIG_SLEW_RATE: case PIN_CONFIG_SLEW_RATE:
...@@ -119,7 +116,7 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, ...@@ -119,7 +116,7 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev,
case PIN_CONFIG_OUTPUT_ENABLE: case PIN_CONFIG_OUTPUT_ENABLE:
err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &ret); err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &ret);
if (err) if (err)
goto out; break;
/* CONFIG Current direction return value /* CONFIG Current direction return value
* ------------- ----------------- ---------------------- * ------------- ----------------- ----------------------
* OUTPUT_ENABLE output 1 (= HW value) * OUTPUT_ENABLE output 1 (= HW value)
...@@ -134,23 +131,21 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, ...@@ -134,23 +131,21 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev,
case PIN_CONFIG_INPUT_SCHMITT_ENABLE: case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &ret); err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &ret);
if (err) if (err)
goto out; break;
/* return error when in output mode /* return error when in output mode
* because schmitt trigger only work in input mode * because schmitt trigger only work in input mode
*/ */
if (ret) { if (ret) {
err = -EINVAL; err = -EINVAL;
goto out; break;
} }
err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_SMT, &ret); err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_SMT, &ret);
break; break;
case PIN_CONFIG_DRIVE_STRENGTH: case PIN_CONFIG_DRIVE_STRENGTH:
if (hw->soc->drive_get) if (!hw->soc->drive_get)
err = hw->soc->drive_get(hw, desc, &ret); break;
else err = hw->soc->drive_get(hw, desc, &ret);
err = -ENOTSUPP;
break; break;
case MTK_PIN_CONFIG_TDSEL: case MTK_PIN_CONFIG_TDSEL:
case MTK_PIN_CONFIG_RDSEL: case MTK_PIN_CONFIG_RDSEL:
...@@ -160,23 +155,18 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, ...@@ -160,23 +155,18 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev,
break; break;
case MTK_PIN_CONFIG_PU_ADV: case MTK_PIN_CONFIG_PU_ADV:
case MTK_PIN_CONFIG_PD_ADV: case MTK_PIN_CONFIG_PD_ADV:
if (hw->soc->adv_pull_get) { if (!hw->soc->adv_pull_get)
pullup = param == MTK_PIN_CONFIG_PU_ADV; break;
err = hw->soc->adv_pull_get(hw, desc, pullup, &ret); pullup = param == MTK_PIN_CONFIG_PU_ADV;
} else err = hw->soc->adv_pull_get(hw, desc, pullup, &ret);
err = -ENOTSUPP;
break; break;
case MTK_PIN_CONFIG_DRV_ADV: case MTK_PIN_CONFIG_DRV_ADV:
if (hw->soc->adv_drive_get) if (!hw->soc->adv_drive_get)
err = hw->soc->adv_drive_get(hw, desc, &ret); break;
else err = hw->soc->adv_drive_get(hw, desc, &ret);
err = -ENOTSUPP;
break; break;
default:
err = -ENOTSUPP;
} }
out:
if (!err) if (!err)
*config = pinconf_to_config_packed(param, ret); *config = pinconf_to_config_packed(param, ret);
...@@ -188,33 +178,29 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -188,33 +178,29 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
{ {
struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev); struct mtk_pinctrl *hw = pinctrl_dev_get_drvdata(pctldev);
const struct mtk_pin_desc *desc; const struct mtk_pin_desc *desc;
int err = 0; int err = -ENOTSUPP;
u32 reg; u32 reg;
if (pin >= hw->soc->npins) { if (pin >= hw->soc->npins)
err = -EINVAL; return -EINVAL;
goto err;
}
desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin]; desc = (const struct mtk_pin_desc *)&hw->soc->pins[pin];
switch ((u32)param) { switch ((u32)param) {
case PIN_CONFIG_BIAS_DISABLE: case PIN_CONFIG_BIAS_DISABLE:
if (hw->soc->bias_set_combo) if (!hw->soc->bias_set_combo)
err = hw->soc->bias_set_combo(hw, desc, 0, MTK_DISABLE); break;
else err = hw->soc->bias_set_combo(hw, desc, 0, MTK_DISABLE);
err = -ENOTSUPP;
break; break;
case PIN_CONFIG_BIAS_PULL_UP: case PIN_CONFIG_BIAS_PULL_UP:
if (hw->soc->bias_set_combo) if (!hw->soc->bias_set_combo)
err = hw->soc->bias_set_combo(hw, desc, 1, arg); break;
else err = hw->soc->bias_set_combo(hw, desc, 1, arg);
err = -ENOTSUPP;
break; break;
case PIN_CONFIG_BIAS_PULL_DOWN: case PIN_CONFIG_BIAS_PULL_DOWN:
if (hw->soc->bias_set_combo) if (!hw->soc->bias_set_combo)
err = hw->soc->bias_set_combo(hw, desc, 0, arg); break;
else err = hw->soc->bias_set_combo(hw, desc, 0, arg);
err = -ENOTSUPP;
break; break;
case PIN_CONFIG_OUTPUT_ENABLE: case PIN_CONFIG_OUTPUT_ENABLE:
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT, err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT,
...@@ -223,7 +209,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -223,7 +209,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
* does not have SMT control * does not have SMT control
*/ */
if (err != -ENOTSUPP) if (err != -ENOTSUPP)
goto err; break;
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,
MTK_OUTPUT); MTK_OUTPUT);
...@@ -232,7 +218,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -232,7 +218,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
/* regard all non-zero value as enable */ /* regard all non-zero value as enable */
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_IES, !!arg); err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_IES, !!arg);
if (err) if (err)
goto err; break;
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,
MTK_INPUT); MTK_INPUT);
...@@ -245,7 +231,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -245,7 +231,7 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DO, err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DO,
arg); arg);
if (err) if (err)
goto err; break;
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,
MTK_OUTPUT); MTK_OUTPUT);
...@@ -257,15 +243,14 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -257,15 +243,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); err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, !arg);
if (err) if (err)
goto err; break;
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT, !!arg); err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT, !!arg);
break; break;
case PIN_CONFIG_DRIVE_STRENGTH: case PIN_CONFIG_DRIVE_STRENGTH:
if (hw->soc->drive_set) if (!hw->soc->drive_set)
err = hw->soc->drive_set(hw, desc, arg); break;
else err = hw->soc->drive_set(hw, desc, arg);
err = -ENOTSUPP;
break; break;
case MTK_PIN_CONFIG_TDSEL: case MTK_PIN_CONFIG_TDSEL:
case MTK_PIN_CONFIG_RDSEL: case MTK_PIN_CONFIG_RDSEL:
...@@ -275,26 +260,19 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -275,26 +260,19 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
break; break;
case MTK_PIN_CONFIG_PU_ADV: case MTK_PIN_CONFIG_PU_ADV:
case MTK_PIN_CONFIG_PD_ADV: case MTK_PIN_CONFIG_PD_ADV:
if (hw->soc->adv_pull_set) { if (!hw->soc->adv_pull_set)
bool pullup; break;
err = hw->soc->adv_pull_set(hw, desc,
pullup = param == MTK_PIN_CONFIG_PU_ADV; (param == MTK_PIN_CONFIG_PU_ADV),
err = hw->soc->adv_pull_set(hw, desc, pullup, arg);
arg);
} else
err = -ENOTSUPP;
break; break;
case MTK_PIN_CONFIG_DRV_ADV: case MTK_PIN_CONFIG_DRV_ADV:
if (hw->soc->adv_drive_set) if (!hw->soc->adv_drive_set)
err = hw->soc->adv_drive_set(hw, desc, arg); break;
else err = hw->soc->adv_drive_set(hw, desc, arg);
err = -ENOTSUPP;
break; break;
default:
err = -ENOTSUPP;
} }
err:
return err; return err;
} }
......
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