Merge remote-tracking branch 'regulator/fix/pbias' into regulator-linus
This commit is contained in:
Коммит
3896257137
|
@ -38,66 +38,24 @@ struct pbias_reg_info {
|
|||
struct pbias_regulator_data {
|
||||
struct regulator_desc desc;
|
||||
void __iomem *pbias_addr;
|
||||
unsigned int pbias_reg;
|
||||
struct regulator_dev *dev;
|
||||
struct regmap *syscon;
|
||||
const struct pbias_reg_info *info;
|
||||
int voltage;
|
||||
};
|
||||
|
||||
static int pbias_regulator_set_voltage(struct regulator_dev *dev,
|
||||
int min_uV, int max_uV, unsigned *selector)
|
||||
{
|
||||
struct pbias_regulator_data *data = rdev_get_drvdata(dev);
|
||||
const struct pbias_reg_info *info = data->info;
|
||||
int ret, vmode;
|
||||
|
||||
if (min_uV <= 1800000)
|
||||
vmode = 0;
|
||||
else if (min_uV > 1800000)
|
||||
vmode = info->vmode;
|
||||
|
||||
ret = regmap_update_bits(data->syscon, data->pbias_reg,
|
||||
info->vmode, vmode);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int pbias_regulator_get_voltage(struct regulator_dev *rdev)
|
||||
{
|
||||
struct pbias_regulator_data *data = rdev_get_drvdata(rdev);
|
||||
const struct pbias_reg_info *info = data->info;
|
||||
int value, voltage;
|
||||
|
||||
regmap_read(data->syscon, data->pbias_reg, &value);
|
||||
value &= info->vmode;
|
||||
|
||||
voltage = value ? 3000000 : 1800000;
|
||||
|
||||
return voltage;
|
||||
}
|
||||
static const unsigned int pbias_volt_table[] = {
|
||||
1800000,
|
||||
3000000
|
||||
};
|
||||
|
||||
static int pbias_regulator_enable(struct regulator_dev *rdev)
|
||||
{
|
||||
struct pbias_regulator_data *data = rdev_get_drvdata(rdev);
|
||||
const struct pbias_reg_info *info = data->info;
|
||||
int ret;
|
||||
|
||||
ret = regmap_update_bits(data->syscon, data->pbias_reg,
|
||||
info->enable_mask, info->enable);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int pbias_regulator_disable(struct regulator_dev *rdev)
|
||||
{
|
||||
struct pbias_regulator_data *data = rdev_get_drvdata(rdev);
|
||||
const struct pbias_reg_info *info = data->info;
|
||||
int ret;
|
||||
|
||||
ret = regmap_update_bits(data->syscon, data->pbias_reg,
|
||||
info->enable_mask, 0);
|
||||
return ret;
|
||||
return regmap_update_bits(data->syscon, rdev->desc->enable_reg,
|
||||
info->enable_mask, info->enable);
|
||||
}
|
||||
|
||||
static int pbias_regulator_is_enable(struct regulator_dev *rdev)
|
||||
|
@ -106,17 +64,18 @@ static int pbias_regulator_is_enable(struct regulator_dev *rdev)
|
|||
const struct pbias_reg_info *info = data->info;
|
||||
int value;
|
||||
|
||||
regmap_read(data->syscon, data->pbias_reg, &value);
|
||||
regmap_read(data->syscon, rdev->desc->enable_reg, &value);
|
||||
|
||||
return (value & info->enable_mask) == info->enable_mask;
|
||||
return (value & info->enable_mask) == info->enable;
|
||||
}
|
||||
|
||||
static struct regulator_ops pbias_regulator_voltage_ops = {
|
||||
.set_voltage = pbias_regulator_set_voltage,
|
||||
.get_voltage = pbias_regulator_get_voltage,
|
||||
.enable = pbias_regulator_enable,
|
||||
.disable = pbias_regulator_disable,
|
||||
.is_enabled = pbias_regulator_is_enable,
|
||||
.list_voltage = regulator_list_voltage_table,
|
||||
.get_voltage_sel = regulator_get_voltage_sel_regmap,
|
||||
.set_voltage_sel = regulator_set_voltage_sel_regmap,
|
||||
.enable = pbias_regulator_enable,
|
||||
.disable = regulator_disable_regmap,
|
||||
.is_enabled = pbias_regulator_is_enable,
|
||||
};
|
||||
|
||||
static const struct pbias_reg_info pbias_mmc_omap2430 = {
|
||||
|
@ -192,6 +151,7 @@ static int pbias_regulator_probe(struct platform_device *pdev)
|
|||
if (IS_ERR(syscon))
|
||||
return PTR_ERR(syscon);
|
||||
|
||||
cfg.regmap = syscon;
|
||||
cfg.dev = &pdev->dev;
|
||||
|
||||
for (idx = 0; idx < PBIAS_NUM_REGS && data_idx < count; idx++) {
|
||||
|
@ -207,15 +167,19 @@ static int pbias_regulator_probe(struct platform_device *pdev)
|
|||
if (!res)
|
||||
return -EINVAL;
|
||||
|
||||
drvdata[data_idx].pbias_reg = res->start;
|
||||
drvdata[data_idx].syscon = syscon;
|
||||
drvdata[data_idx].info = info;
|
||||
drvdata[data_idx].desc.name = info->name;
|
||||
drvdata[data_idx].desc.owner = THIS_MODULE;
|
||||
drvdata[data_idx].desc.type = REGULATOR_VOLTAGE;
|
||||
drvdata[data_idx].desc.ops = &pbias_regulator_voltage_ops;
|
||||
drvdata[data_idx].desc.volt_table = pbias_volt_table;
|
||||
drvdata[data_idx].desc.n_voltages = 2;
|
||||
drvdata[data_idx].desc.enable_time = info->enable_time;
|
||||
drvdata[data_idx].desc.vsel_reg = res->start;
|
||||
drvdata[data_idx].desc.vsel_mask = info->vmode;
|
||||
drvdata[data_idx].desc.enable_reg = res->start;
|
||||
drvdata[data_idx].desc.enable_mask = info->enable_mask;
|
||||
|
||||
cfg.init_data = pbias_matches[idx].init_data;
|
||||
cfg.driver_data = &drvdata[data_idx];
|
||||
|
|
Загрузка…
Ссылка в новой задаче