forked from luck/tmp_suning_uos_patched
regulator: rtmv20: Fix .set_current_limit/.get_current_limit callbacks
commit 86ab21cc39e6b99b7065ab9008c90bec5dec535a upstream.
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: b8c054a5ea
("regulator: rtmv20: Adds support for Richtek RTMV20 load switch regulator")
Signed-off-by: Axel Lin <axel.lin@ingics.com>
Reviewed-by: ChiYuan Huang <cy_huang@richtek.com>
Link: https://lore.kernel.org/r/20210530124101.477727-1-axel.lin@ingics.com
Signed-off-by: Mark Brown <broonie@kernel.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
This commit is contained in:
parent
4579f65176
commit
aafc51fddf
|
@ -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,
|
||||
|
|
Loading…
Reference in New Issue
Block a user