Commit 5d9de8b1 authored by Axel Lin's avatar Axel Lin Committed by Mark Brown

regulator: ab8500: Get rid of voltage_shift field from struct ab8500_regulator_info

The voltage_shift can be calculated from voltage_mask.
Let's remove voltage_shift fied from struct ab8500_regulator_info, this change
can prevent missing voltage_shift setting issue.
Signed-off-by: default avatarAxel Lin <axel.lin@ingics.com>
Acked-by: default avatarBengt Jonsson <bengt.g.jonsson@stericsson.com>
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent 9135d3bc
...@@ -61,7 +61,6 @@ struct ab8500_shared_mode { ...@@ -61,7 +61,6 @@ struct ab8500_shared_mode {
* @voltage_bank: bank to control regulator voltage * @voltage_bank: bank to control regulator voltage
* @voltage_reg: register to control regulator voltage * @voltage_reg: register to control regulator voltage
* @voltage_mask: mask to control regulator voltage * @voltage_mask: mask to control regulator voltage
* @voltage_shift: shift to control regulator voltage
*/ */
struct ab8500_regulator_info { struct ab8500_regulator_info {
struct device *dev; struct device *dev;
...@@ -83,7 +82,6 @@ struct ab8500_regulator_info { ...@@ -83,7 +82,6 @@ struct ab8500_regulator_info {
u8 voltage_bank; u8 voltage_bank;
u8 voltage_reg; u8 voltage_reg;
u8 voltage_mask; u8 voltage_mask;
u8 voltage_shift;
struct { struct {
u8 voltage_limit; u8 voltage_limit;
u8 voltage_bank; u8 voltage_bank;
...@@ -480,7 +478,7 @@ static unsigned int ab8500_regulator_get_mode(struct regulator_dev *rdev) ...@@ -480,7 +478,7 @@ static unsigned int ab8500_regulator_get_mode(struct regulator_dev *rdev)
static int ab8500_regulator_get_voltage_sel(struct regulator_dev *rdev) static int ab8500_regulator_get_voltage_sel(struct regulator_dev *rdev)
{ {
int ret, val; int ret, voltage_shift;
struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); struct ab8500_regulator_info *info = rdev_get_drvdata(rdev);
u8 regval; u8 regval;
...@@ -489,6 +487,8 @@ static int ab8500_regulator_get_voltage_sel(struct regulator_dev *rdev) ...@@ -489,6 +487,8 @@ static int ab8500_regulator_get_voltage_sel(struct regulator_dev *rdev)
return -EINVAL; return -EINVAL;
} }
voltage_shift = ffs(info->voltage_mask) - 1;
ret = abx500_get_register_interruptible(info->dev, ret = abx500_get_register_interruptible(info->dev,
info->voltage_bank, info->voltage_reg, &regval); info->voltage_bank, info->voltage_reg, &regval);
if (ret < 0) { if (ret < 0) {
...@@ -502,15 +502,14 @@ static int ab8500_regulator_get_voltage_sel(struct regulator_dev *rdev) ...@@ -502,15 +502,14 @@ static int ab8500_regulator_get_voltage_sel(struct regulator_dev *rdev)
"0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", "0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n",
info->desc.name, info->voltage_bank, info->desc.name, info->voltage_bank,
info->voltage_reg, info->voltage_mask, info->voltage_reg, info->voltage_mask,
info->voltage_shift, regval); voltage_shift, regval);
val = regval & info->voltage_mask; return (regval & info->voltage_mask) >> voltage_shift;
return val >> info->voltage_shift;
} }
static int ab8540_aux3_regulator_get_voltage_sel(struct regulator_dev *rdev) static int ab8540_aux3_regulator_get_voltage_sel(struct regulator_dev *rdev)
{ {
int ret; int ret, voltage_shift;
struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); struct ab8500_regulator_info *info = rdev_get_drvdata(rdev);
u8 regval, regval_expand; u8 regval, regval_expand;
...@@ -550,13 +549,15 @@ static int ab8540_aux3_regulator_get_voltage_sel(struct regulator_dev *rdev) ...@@ -550,13 +549,15 @@ static int ab8540_aux3_regulator_get_voltage_sel(struct regulator_dev *rdev)
info->desc.name, info->voltage_bank, info->voltage_reg, info->desc.name, info->voltage_bank, info->voltage_reg,
info->voltage_mask, regval); info->voltage_mask, regval);
return (regval & info->voltage_mask) >> info->voltage_shift; voltage_shift = ffs(info->voltage_mask) - 1;
return (regval & info->voltage_mask) >> voltage_shift;
} }
static int ab8500_regulator_set_voltage_sel(struct regulator_dev *rdev, static int ab8500_regulator_set_voltage_sel(struct regulator_dev *rdev,
unsigned selector) unsigned selector)
{ {
int ret; int ret, voltage_shift;
struct ab8500_regulator_info *info = rdev_get_drvdata(rdev); struct ab8500_regulator_info *info = rdev_get_drvdata(rdev);
u8 regval; u8 regval;
...@@ -565,8 +566,10 @@ static int ab8500_regulator_set_voltage_sel(struct regulator_dev *rdev, ...@@ -565,8 +566,10 @@ static int ab8500_regulator_set_voltage_sel(struct regulator_dev *rdev,
return -EINVAL; return -EINVAL;
} }
voltage_shift = ffs(info->voltage_mask) - 1;
/* set the registers for the request */ /* set the registers for the request */
regval = (u8)selector << info->voltage_shift; regval = (u8)selector << voltage_shift;
ret = abx500_mask_and_set_register_interruptible(info->dev, ret = abx500_mask_and_set_register_interruptible(info->dev,
info->voltage_bank, info->voltage_reg, info->voltage_bank, info->voltage_reg,
info->voltage_mask, regval); info->voltage_mask, regval);
...@@ -596,7 +599,9 @@ static int ab8540_aux3_regulator_set_voltage_sel(struct regulator_dev *rdev, ...@@ -596,7 +599,9 @@ static int ab8540_aux3_regulator_set_voltage_sel(struct regulator_dev *rdev,
} }
if (selector < info->expand_register.voltage_limit) { if (selector < info->expand_register.voltage_limit) {
regval = (u8)selector << info->voltage_shift; int voltage_shift = ffs(info->voltage_mask) - 1;
regval = (u8)selector << voltage_shift;
ret = abx500_mask_and_set_register_interruptible(info->dev, ret = abx500_mask_and_set_register_interruptible(info->dev,
info->voltage_bank, info->voltage_reg, info->voltage_bank, info->voltage_reg,
info->voltage_mask, regval); info->voltage_mask, regval);
...@@ -791,7 +796,6 @@ static struct ab8500_regulator_info ...@@ -791,7 +796,6 @@ static struct ab8500_regulator_info
.voltage_bank = 0x03, .voltage_bank = 0x03,
.voltage_reg = 0x80, .voltage_reg = 0x80,
.voltage_mask = 0x38, .voltage_mask = 0x38,
.voltage_shift = 3,
}, },
/* /*
...@@ -1066,7 +1070,6 @@ static struct ab8500_regulator_info ...@@ -1066,7 +1070,6 @@ static struct ab8500_regulator_info
.voltage_bank = 0x03, .voltage_bank = 0x03,
.voltage_reg = 0x80, .voltage_reg = 0x80,
.voltage_mask = 0x38, .voltage_mask = 0x38,
.voltage_shift = 3,
}, },
/* /*
...@@ -1127,7 +1130,6 @@ static struct ab8500_regulator_info ...@@ -1127,7 +1130,6 @@ static struct ab8500_regulator_info
.voltage_bank = 0x01, .voltage_bank = 0x01,
.voltage_reg = 0x57, .voltage_reg = 0x57,
.voltage_mask = 0x70, .voltage_mask = 0x70,
.voltage_shift = 4,
}, },
[AB8505_LDO_ANAMIC1] = { [AB8505_LDO_ANAMIC1] = {
.desc = { .desc = {
...@@ -1327,7 +1329,6 @@ static struct ab8500_regulator_info ...@@ -1327,7 +1329,6 @@ static struct ab8500_regulator_info
.voltage_bank = 0x03, .voltage_bank = 0x03,
.voltage_reg = 0x80, .voltage_reg = 0x80,
.voltage_mask = 0x38, .voltage_mask = 0x38,
.voltage_shift = 3,
}, },
/* /*
...@@ -1622,7 +1623,6 @@ static struct ab8500_regulator_info ...@@ -1622,7 +1623,6 @@ static struct ab8500_regulator_info
.voltage_bank = 0x03, .voltage_bank = 0x03,
.voltage_reg = 0x80, .voltage_reg = 0x80,
.voltage_mask = 0x38, .voltage_mask = 0x38,
.voltage_shift = 3,
}, },
/* /*
...@@ -1724,7 +1724,6 @@ static struct ab8500_regulator_info ...@@ -1724,7 +1724,6 @@ static struct ab8500_regulator_info
.voltage_bank = 0x03, .voltage_bank = 0x03,
.voltage_reg = 0x83, .voltage_reg = 0x83,
.voltage_mask = 0xc0, .voltage_mask = 0xc0,
.voltage_shift = 6,
}, },
/* /*
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment