[PATCH] pinctrl: mediatek: fix mode encoding

From: matthias . bgg
Date: Tue Jun 08 2021 - 11:08:55 EST


From: Matthias Brugger <mbrugger@xxxxxxxx>

Pin modes are encoded in the SoC data structure. Use that value to set
IES SMT.

Cc: Fabien Parent <fparent@xxxxxxxxxxxx>
Cc: Sean Wang <sean.wang@xxxxxxxxxx>
Cc: Mattijs Korpershoek <mkorpershoek@xxxxxxxxxxxx>
Cc: linux-mediatek@xxxxxxxxxxxxxxxxxxx
Fixes: 696beef77521 ("pinctrl: mediatek: move bit assignment")
Signed-off-by: Matthias Brugger <matthias.bgg@xxxxxxxxx>

Signed-off-by: Matthias Brugger <mbrugger@xxxxxxxx>
---

drivers/pinctrl/mediatek/pinctrl-mtk-common.c | 4 ++--
1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/drivers/pinctrl/mediatek/pinctrl-mtk-common.c b/drivers/pinctrl/mediatek/pinctrl-mtk-common.c
index 525b1aa7f7a6..5f7c421ab6e7 100644
--- a/drivers/pinctrl/mediatek/pinctrl-mtk-common.c
+++ b/drivers/pinctrl/mediatek/pinctrl-mtk-common.c
@@ -134,13 +134,13 @@ static int mtk_pconf_set_ies_smt(struct mtk_pinctrl *pctl, unsigned pin,
pin, pctl->devdata->port_align, value, arg);
}

- bit = BIT(pin & 0xf);
-
if (arg == PIN_CONFIG_INPUT_ENABLE)
offset = pctl->devdata->ies_offset;
else
offset = pctl->devdata->smt_offset;

+ bit = BIT(offset & pctl->devdata->mode_mask);
+
if (value)
reg_addr = SET_ADDR(mtk_get_port(pctl, pin) + offset, pctl);
else
--
2.31.1