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

Commit 3ad38a14 authored by Sean Wang's avatar Sean Wang Committed by Linus Walleij
Browse files

pinctrl: mediatek: add drv register support to pinctrl-mtk-common-v2.c 



Certain SoCs have to program DRV register to configure driving
strength so that we add it in the existing path as an option.

Signed-off-by: default avatarRyder.Lee <ryder.lee@mediatek.com>
Signed-off-by: default avatarSean Wang <sean.wang@mediatek.com>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
parent c2832197

drivers/pinctrl/mediatek/pinctrl-mtk-common-v2.c

+38 −0
Original line number Diff line number Diff line
@@ -242,3 +242,41 @@ int mtk_pinconf_drive_get(struct mtk_pinctrl *hw, 


	return 0;

}



/* Revision 1 */

int mtk_pinconf_drive_set_rev1(struct mtk_pinctrl *hw,

			       const struct mtk_pin_desc *desc, u32 arg)

{

	const struct mtk_drive_desc *tb;

	int err = -ENOTSUPP;



	tb = &mtk_drive[desc->drv_n];



	if ((arg >= tb->min && arg <= tb->max) && !(arg % tb->step)) {

		arg = (arg / tb->step - 1) * tb->scal;



		err = mtk_hw_set_value(hw, desc->number, PINCTRL_PIN_REG_DRV,

				       arg);

		if (err)

			return err;

	}



	return err;

}



int mtk_pinconf_drive_get_rev1(struct mtk_pinctrl *hw,

			       const struct mtk_pin_desc *desc, int *val)

{

	const struct mtk_drive_desc *tb;

	int err, val1;



	tb = &mtk_drive[desc->drv_n];



	err = mtk_hw_get_value(hw, desc->number, PINCTRL_PIN_REG_DRV, &val1);

	if (err)

		return err;



	*val = ((val1 & 0x7) / tb->scal + 1) * tb->step;



	return 0;

}

drivers/pinctrl/mediatek/pinctrl-mtk-common-v2.h

+5 −0
Original line number Diff line number Diff line
@@ -175,4 +175,9 @@ int mtk_pinconf_drive_set(struct mtk_pinctrl *hw, 
int mtk_pinconf_drive_get(struct mtk_pinctrl *hw,

			  const struct mtk_pin_desc *desc, int *val);



int mtk_pinconf_drive_set_rev1(struct mtk_pinctrl *hw,

			       const struct mtk_pin_desc *desc, u32 arg);

int mtk_pinconf_drive_get_rev1(struct mtk_pinctrl *hw,

			       const struct mtk_pin_desc *desc, int *val);



#endif /* __PINCTRL_MTK_COMMON_V2_H */