forked from Minki/linux
regulator: Simplify the code to get selector in isl6271a_set_voltage
Signed-off-by: Axel Lin <axel.lin@gmail.com> Acked-by: Marek Vasut <marek.vasut@gmail.com> Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
This commit is contained in:
parent
7b94791be6
commit
48ee1160a4
@ -63,23 +63,15 @@ static int isl6271a_set_voltage(struct regulator_dev *dev,
|
||||
unsigned *selector)
|
||||
{
|
||||
struct isl_pmic *pmic = rdev_get_drvdata(dev);
|
||||
int vsel, err, data;
|
||||
int err, data;
|
||||
|
||||
if (minuV < ISL6271A_VOLTAGE_MIN || minuV > ISL6271A_VOLTAGE_MAX)
|
||||
return -EINVAL;
|
||||
if (maxuV < ISL6271A_VOLTAGE_MIN || maxuV > ISL6271A_VOLTAGE_MAX)
|
||||
return -EINVAL;
|
||||
|
||||
/* Align to 50000 mV */
|
||||
vsel = minuV - (minuV % ISL6271A_VOLTAGE_STEP);
|
||||
|
||||
/* If the result fell out of [minuV,maxuV] range, put it back */
|
||||
if (vsel < minuV)
|
||||
vsel += ISL6271A_VOLTAGE_STEP;
|
||||
|
||||
/* Convert the microvolts to data for the chip */
|
||||
data = (vsel - ISL6271A_VOLTAGE_MIN) / ISL6271A_VOLTAGE_STEP;
|
||||
|
||||
data = DIV_ROUND_UP(minuV - ISL6271A_VOLTAGE_MIN,
|
||||
ISL6271A_VOLTAGE_STEP);
|
||||
*selector = data;
|
||||
|
||||
mutex_lock(&pmic->mtx);
|
||||
|
Loading…
Reference in New Issue
Block a user