Unverified Commit 86ab21cc authored by Axel Lin's avatar Axel Lin Committed by Mark Brown
Browse files

regulator: rtmv20: Fix .set_current_limit/.get_current_limit callbacks 



Current code does not set .curr_table and .n_linear_ranges settings,
so it cannot use the regulator_get/set_current_limit_regmap helpers.
If we setup the curr_table, it will has 200 entries.
Implement customized .set_current_limit/.get_current_limit callbacks
instead.

Fixes: b8c054a5 ("regulator: rtmv20: Adds support for Richtek RTMV20 load switch regulator")
Signed-off-by: default avatarAxel Lin <axel.lin@ingics.com>
Reviewed-by: default avatarChiYuan Huang <cy_huang@richtek.com>
Link: https://lore.kernel.org/r/20210530124101.477727-1-axel.lin@ingics.com


Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent a072cbda

drivers/regulator/rtmv20-regulator.c

+40 −2
Original line number Diff line number Diff line
@@ -103,9 +103,47 @@ static int rtmv20_lsw_disable(struct regulator_dev *rdev) 
	return 0;

}



static int rtmv20_lsw_set_current_limit(struct regulator_dev *rdev, int min_uA,

					int max_uA)

{

	int sel;



	if (min_uA > RTMV20_LSW_MAXUA || max_uA < RTMV20_LSW_MINUA)

		return -EINVAL;



	if (max_uA > RTMV20_LSW_MAXUA)

		max_uA = RTMV20_LSW_MAXUA;



	sel = (max_uA - RTMV20_LSW_MINUA) / RTMV20_LSW_STEPUA;



	/* Ensure the selected setting is still in range */

	if ((sel * RTMV20_LSW_STEPUA + RTMV20_LSW_MINUA) < min_uA)

		return -EINVAL;



	sel <<= ffs(rdev->desc->csel_mask) - 1;



	return regmap_update_bits(rdev->regmap, rdev->desc->csel_reg,

				  rdev->desc->csel_mask, sel);

}



static int rtmv20_lsw_get_current_limit(struct regulator_dev *rdev)

{

	unsigned int val;

	int ret;



	ret = regmap_read(rdev->regmap, rdev->desc->csel_reg, &val);

	if (ret)

		return ret;



	val &= rdev->desc->csel_mask;

	val >>= ffs(rdev->desc->csel_mask) - 1;



	return val * RTMV20_LSW_STEPUA + RTMV20_LSW_MINUA;

}



static const struct regulator_ops rtmv20_regulator_ops = {

	.set_current_limit = regulator_set_current_limit_regmap,

	.get_current_limit = regulator_get_current_limit_regmap,

	.set_current_limit = rtmv20_lsw_set_current_limit,

	.get_current_limit = rtmv20_lsw_get_current_limit,

	.enable = rtmv20_lsw_enable,

	.disable = rtmv20_lsw_disable,

	.is_enabled = regulator_is_enabled_regmap,