Commit 3599cc52 authored by Light Hsieh's avatar Light Hsieh Committed by Linus Walleij

pinctrl: mediatek: Refine mtk_pinconf_get() and mtk_pinconf_set()

1.Refine mtk_pinconf_get():
  Use only one occurrence of return at end of this function.

2.Refine mtk_pinconf_set():
2.1 Use only one occurrence of return at end of this function.
2.2 Modify case of PIN_CONFIG_INPUT_ENABLE -
2.2.1
    Regard all non-zero setting value as enable, instead of always enable.
2.2.2
    Remove check of ies_present flag and always invoke mtk_hw_set_value()
    since mtk_hw_pin_field_lookup() invoked inside mtk_hw_set_value() has
    the same effect of checking if ies control is supported.
    [The rationale is that: available of a control is always checked
     in mtk_hw_pin_field_lookup() and no need to add ies_present flag
     specially for ies control.]
2.3 Simply code logic for case of PIN_CONFIG_INPUT_SCHMITT.
2.4 Add case for PIN_CONFIG_INPUT_SCHMITT_ENABLE and process it with the
    same code for case of PIN_CONFIG_INPUT_SCHMITT.
Signed-off-by: default avatarLight Hsieh <light.hsieh@mediatek.com>
Link: https://lore.kernel.org/r/1579675994-7001-3-git-send-email-light.hsieh@mediatek.comAcked-by: default avatarSean Wang <sean.wang@kernel.org>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
parent 5f755e1f
...@@ -1070,7 +1070,6 @@ static const struct mtk_pin_soc mt6765_data = { ...@@ -1070,7 +1070,6 @@ static const struct mtk_pin_soc mt6765_data = {
.ngrps = ARRAY_SIZE(mtk_pins_mt6765), .ngrps = ARRAY_SIZE(mtk_pins_mt6765),
.eint_hw = &mt6765_eint_hw, .eint_hw = &mt6765_eint_hw,
.gpio_m = 0, .gpio_m = 0,
.ies_present = true,
.base_names = mt6765_pinctrl_register_base_names, .base_names = mt6765_pinctrl_register_base_names,
.nbase_names = ARRAY_SIZE(mt6765_pinctrl_register_base_names), .nbase_names = ARRAY_SIZE(mt6765_pinctrl_register_base_names),
.bias_disable_set = mtk_pinconf_bias_disable_set, .bias_disable_set = mtk_pinconf_bias_disable_set,
......
...@@ -554,7 +554,6 @@ static const struct mtk_pin_soc mt8183_data = { ...@@ -554,7 +554,6 @@ static const struct mtk_pin_soc mt8183_data = {
.ngrps = ARRAY_SIZE(mtk_pins_mt8183), .ngrps = ARRAY_SIZE(mtk_pins_mt8183),
.eint_hw = &mt8183_eint_hw, .eint_hw = &mt8183_eint_hw,
.gpio_m = 0, .gpio_m = 0,
.ies_present = true,
.base_names = mt8183_pinctrl_register_base_names, .base_names = mt8183_pinctrl_register_base_names,
.nbase_names = ARRAY_SIZE(mt8183_pinctrl_register_base_names), .nbase_names = ARRAY_SIZE(mt8183_pinctrl_register_base_names),
.bias_disable_set = mtk_pinconf_bias_disable_set_rev1, .bias_disable_set = mtk_pinconf_bias_disable_set_rev1,
......
...@@ -81,37 +81,30 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, ...@@ -81,37 +81,30 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev,
int val, val2, err, reg, ret = 1; int val, val2, err, reg, ret = 1;
const struct mtk_pin_desc *desc; const struct mtk_pin_desc *desc;
if (pin >= hw->soc->npins) if (pin >= hw->soc->npins) {
return -EINVAL; err = -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:
if (hw->soc->bias_disable_get) { if (hw->soc->bias_disable_get)
err = hw->soc->bias_disable_get(hw, desc, &ret); err = hw->soc->bias_disable_get(hw, desc, &ret);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -ENOTSUPP;
}
break; break;
case PIN_CONFIG_BIAS_PULL_UP: case PIN_CONFIG_BIAS_PULL_UP:
if (hw->soc->bias_get) { if (hw->soc->bias_get)
err = hw->soc->bias_get(hw, desc, 1, &ret); err = hw->soc->bias_get(hw, desc, 1, &ret);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -ENOTSUPP;
}
break; break;
case PIN_CONFIG_BIAS_PULL_DOWN: case PIN_CONFIG_BIAS_PULL_DOWN:
if (hw->soc->bias_get) { if (hw->soc->bias_get)
err = hw->soc->bias_get(hw, desc, 0, &ret); err = hw->soc->bias_get(hw, desc, 0, &ret);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -ENOTSUPP;
}
break; break;
case PIN_CONFIG_SLEW_RATE: case PIN_CONFIG_SLEW_RATE:
err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_SR, &val); err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_SR, &val);
...@@ -126,12 +119,16 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, ...@@ -126,12 +119,16 @@ 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, &val); err = mtk_hw_get_value(hw, desc, PINCTRL_PIN_REG_DIR, &val);
if (err) if (err)
return err; goto out;
/* CONFIG Current direction return value
/* HW takes input mode as zero; output mode as non-zero */ * ------------- ----------------- ----------------------
if ((val && param == PIN_CONFIG_INPUT_ENABLE) || * OUTPUT_ENABLE output 1 (= HW value)
(!val && param == PIN_CONFIG_OUTPUT_ENABLE)) * input 0 (= HW value)
return -EINVAL; * INPUT_ENABLE output 0 (= reverse HW value)
* input 1 (= reverse HW value)
*/
if (param == PIN_CONFIG_INPUT_ENABLE)
val = !val;
break; break;
case PIN_CONFIG_INPUT_SCHMITT_ENABLE: case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
...@@ -148,13 +145,10 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, ...@@ -148,13 +145,10 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev,
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); err = hw->soc->drive_get(hw, desc, &ret);
if (err) else
return err;
} else {
err = -ENOTSUPP; err = -ENOTSUPP;
}
break; break;
case MTK_PIN_CONFIG_TDSEL: case MTK_PIN_CONFIG_TDSEL:
case MTK_PIN_CONFIG_RDSEL: case MTK_PIN_CONFIG_RDSEL:
...@@ -175,28 +169,24 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev, ...@@ -175,28 +169,24 @@ static int mtk_pinconf_get(struct pinctrl_dev *pctldev,
pullup = param == MTK_PIN_CONFIG_PU_ADV; pullup = param == MTK_PIN_CONFIG_PU_ADV;
err = hw->soc->adv_pull_get(hw, desc, pullup, &ret); err = hw->soc->adv_pull_get(hw, desc, pullup, &ret);
if (err) } else
return err; err = -ENOTSUPP;
} else {
return -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); err = hw->soc->adv_drive_get(hw, desc, &ret);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -ENOTSUPP;
}
break; break;
default: default:
return -ENOTSUPP; err = -ENOTSUPP;
} }
*config = pinconf_to_config_packed(param, ret); out:
if (!err)
*config = pinconf_to_config_packed(param, ret);
return 0; return err;
} }
static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
...@@ -216,60 +206,47 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -216,60 +206,47 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
switch ((u32)param) { switch ((u32)param) {
case PIN_CONFIG_BIAS_DISABLE: case PIN_CONFIG_BIAS_DISABLE:
if (hw->soc->bias_disable_set) { if (hw->soc->bias_disable_set)
err = hw->soc->bias_disable_set(hw, desc); err = hw->soc->bias_disable_set(hw, desc);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -ENOTSUPP;
}
break; break;
case PIN_CONFIG_BIAS_PULL_UP: case PIN_CONFIG_BIAS_PULL_UP:
if (hw->soc->bias_set) { if (hw->soc->bias_set)
err = hw->soc->bias_set(hw, desc, 1); err = hw->soc->bias_set(hw, desc, 1);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -ENOTSUPP;
}
break; break;
case PIN_CONFIG_BIAS_PULL_DOWN: case PIN_CONFIG_BIAS_PULL_DOWN:
if (hw->soc->bias_set) { if (hw->soc->bias_set)
err = hw->soc->bias_set(hw, desc, 0); err = hw->soc->bias_set(hw, desc, 0);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -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,
MTK_DISABLE); MTK_DISABLE);
if (err) /* Keep set direction to consider the case that a GPIO pin
* does not have SMT control
*/
if (err != -ENOTSUPP)
goto err; goto err;
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);
if (err)
goto err;
break; break;
case PIN_CONFIG_INPUT_ENABLE: case PIN_CONFIG_INPUT_ENABLE:
if (hw->soc->ies_present) { /* regard all non-zero value as enable */
mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_IES, err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_IES, !!arg);
MTK_ENABLE); if (err)
} goto err;
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);
if (err)
goto err;
break; break;
case PIN_CONFIG_SLEW_RATE: case PIN_CONFIG_SLEW_RATE:
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SR, /* regard all non-zero value as enable */
arg); err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SR, !!arg);
if (err)
goto err;
break; break;
case PIN_CONFIG_OUTPUT: case PIN_CONFIG_OUTPUT:
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,
...@@ -279,41 +256,29 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -279,41 +256,29 @@ 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)
goto err;
break; break;
case PIN_CONFIG_INPUT_SCHMITT:
case PIN_CONFIG_INPUT_SCHMITT_ENABLE: case PIN_CONFIG_INPUT_SCHMITT_ENABLE:
/* arg = 1: Input mode & SMT enable ; /* arg = 1: Input mode & SMT enable ;
* arg = 0: Output mode & SMT disable * arg = 0: Output mode & SMT disable
*/ */
arg = arg ? 2 : 1; err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR, !arg);
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_DIR,
arg & 1);
if (err) if (err)
goto err; goto err;
err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT, err = mtk_hw_set_value(hw, desc, PINCTRL_PIN_REG_SMT, !!arg);
!!(arg & 2));
if (err)
goto err;
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); err = hw->soc->drive_set(hw, desc, arg);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -ENOTSUPP;
}
break; break;
case MTK_PIN_CONFIG_TDSEL: case MTK_PIN_CONFIG_TDSEL:
case MTK_PIN_CONFIG_RDSEL: case MTK_PIN_CONFIG_RDSEL:
reg = (param == MTK_PIN_CONFIG_TDSEL) ? reg = (param == MTK_PIN_CONFIG_TDSEL) ?
PINCTRL_PIN_REG_TDSEL : PINCTRL_PIN_REG_RDSEL; PINCTRL_PIN_REG_TDSEL : PINCTRL_PIN_REG_RDSEL;
err = mtk_hw_set_value(hw, desc, reg, arg); err = mtk_hw_set_value(hw, desc, reg, arg);
if (err)
goto err;
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:
...@@ -323,20 +288,14 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin, ...@@ -323,20 +288,14 @@ static int mtk_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
pullup = param == MTK_PIN_CONFIG_PU_ADV; pullup = param == MTK_PIN_CONFIG_PU_ADV;
err = hw->soc->adv_pull_set(hw, desc, pullup, err = hw->soc->adv_pull_set(hw, desc, pullup,
arg); arg);
if (err) } else
return err; err = -ENOTSUPP;
} else {
return -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); err = hw->soc->adv_drive_set(hw, desc, arg);
if (err) else
return err; err = -ENOTSUPP;
} else {
return -ENOTSUPP;
}
break; break;
default: default:
err = -ENOTSUPP; err = -ENOTSUPP;
......
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