Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 38962571 authored by Mark Brown's avatar Mark Brown
Browse files

Merge remote-tracking branch 'regulator/fix/pbias' into regulator-linus

parents 5c437f42 60e8c1e3

drivers/regulator/pbias-regulator.c

+20 −56
Original line number Diff line number Diff line
@@ -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,

	return regmap_update_bits(data->syscon, rdev->desc->enable_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;

}



static int pbias_regulator_is_enable(struct regulator_dev *rdev)
@@ -106,16 +64,17 @@ 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,

	.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	= pbias_regulator_disable,

	.disable = regulator_disable_regmap,

	.is_enabled = pbias_regulator_is_enable,

};
@@ -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];