Linux Audio

Check our new training course

Loading...
v6.13.7
  1// SPDX-License-Identifier: GPL-2.0+
  2//
  3// Copyright (C) 2011 Freescale Semiconductor, Inc. All Rights Reserved.
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  4
  5#include <linux/slab.h>
  6#include <linux/device.h>
  7#include <linux/module.h>
  8#include <linux/mfd/syscon.h>
  9#include <linux/err.h>
 10#include <linux/io.h>
 11#include <linux/platform_device.h>
 12#include <linux/of.h>
 13#include <linux/of_address.h>
 14#include <linux/regmap.h>
 15#include <linux/regulator/driver.h>
 16#include <linux/regulator/of_regulator.h>
 17#include <linux/regulator/machine.h>
 18
 19#define LDO_RAMP_UP_UNIT_IN_CYCLES      64 /* 64 cycles per step */
 20#define LDO_RAMP_UP_FREQ_IN_MHZ         24 /* cycle based on 24M OSC */
 21
 22#define LDO_POWER_GATE			0x00
 23#define LDO_FET_FULL_ON			0x1f
 24
 25struct anatop_regulator {
 
 
 
 
 26	u32 delay_reg;
 27	int delay_bit_shift;
 28	int delay_bit_width;
 
 
 
 29	struct regulator_desc rdesc;
 
 30	bool bypass;
 31	int sel;
 32};
 33
 34static int anatop_regmap_set_voltage_time_sel(struct regulator_dev *reg,
 35	unsigned int old_sel,
 36	unsigned int new_sel)
 37{
 38	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
 39	u32 val;
 40	int ret = 0;
 41
 42	/* check whether need to care about LDO ramp up speed */
 43	if (anatop_reg->delay_bit_width && new_sel > old_sel) {
 44		/*
 45		 * the delay for LDO ramp up time is
 46		 * based on the register setting, we need
 47		 * to calculate how many steps LDO need to
 48		 * ramp up, and how much delay needed. (us)
 49		 */
 50		regmap_read(reg->regmap, anatop_reg->delay_reg, &val);
 51		val = (val >> anatop_reg->delay_bit_shift) &
 52			((1 << anatop_reg->delay_bit_width) - 1);
 53		ret = (new_sel - old_sel) * (LDO_RAMP_UP_UNIT_IN_CYCLES <<
 54			val) / LDO_RAMP_UP_FREQ_IN_MHZ + 1;
 55	}
 56
 57	return ret;
 58}
 59
 60static int anatop_regmap_enable(struct regulator_dev *reg)
 61{
 62	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
 63	int sel;
 64
 65	sel = anatop_reg->bypass ? LDO_FET_FULL_ON : anatop_reg->sel;
 66	return regulator_set_voltage_sel_regmap(reg, sel);
 67}
 68
 69static int anatop_regmap_disable(struct regulator_dev *reg)
 70{
 71	return regulator_set_voltage_sel_regmap(reg, LDO_POWER_GATE);
 72}
 73
 74static int anatop_regmap_is_enabled(struct regulator_dev *reg)
 75{
 76	return regulator_get_voltage_sel_regmap(reg) != LDO_POWER_GATE;
 77}
 78
 79static int anatop_regmap_core_set_voltage_sel(struct regulator_dev *reg,
 80					      unsigned selector)
 81{
 82	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
 83	int ret;
 84
 85	if (anatop_reg->bypass || !anatop_regmap_is_enabled(reg)) {
 86		anatop_reg->sel = selector;
 87		return 0;
 88	}
 89
 90	ret = regulator_set_voltage_sel_regmap(reg, selector);
 91	if (!ret)
 92		anatop_reg->sel = selector;
 93	return ret;
 94}
 95
 96static int anatop_regmap_core_get_voltage_sel(struct regulator_dev *reg)
 97{
 98	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
 99
100	if (anatop_reg->bypass || !anatop_regmap_is_enabled(reg))
101		return anatop_reg->sel;
102
103	return regulator_get_voltage_sel_regmap(reg);
104}
105
106static int anatop_regmap_get_bypass(struct regulator_dev *reg, bool *enable)
107{
108	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
109	int sel;
110
111	sel = regulator_get_voltage_sel_regmap(reg);
112	if (sel == LDO_FET_FULL_ON)
113		WARN_ON(!anatop_reg->bypass);
114	else if (sel != LDO_POWER_GATE)
115		WARN_ON(anatop_reg->bypass);
116
117	*enable = anatop_reg->bypass;
118	return 0;
119}
120
121static int anatop_regmap_set_bypass(struct regulator_dev *reg, bool enable)
122{
123	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
124	int sel;
125
126	if (enable == anatop_reg->bypass)
127		return 0;
128
129	sel = enable ? LDO_FET_FULL_ON : anatop_reg->sel;
130	anatop_reg->bypass = enable;
131
132	return regulator_set_voltage_sel_regmap(reg, sel);
133}
134
135static struct regulator_ops anatop_rops = {
136	.set_voltage_sel = regulator_set_voltage_sel_regmap,
137	.get_voltage_sel = regulator_get_voltage_sel_regmap,
138	.list_voltage = regulator_list_voltage_linear,
139	.map_voltage = regulator_map_voltage_linear,
140};
141
142static const struct regulator_ops anatop_core_rops = {
143	.enable = anatop_regmap_enable,
144	.disable = anatop_regmap_disable,
145	.is_enabled = anatop_regmap_is_enabled,
146	.set_voltage_sel = anatop_regmap_core_set_voltage_sel,
147	.set_voltage_time_sel = anatop_regmap_set_voltage_time_sel,
148	.get_voltage_sel = anatop_regmap_core_get_voltage_sel,
149	.list_voltage = regulator_list_voltage_linear,
150	.map_voltage = regulator_map_voltage_linear,
151	.get_bypass = anatop_regmap_get_bypass,
152	.set_bypass = anatop_regmap_set_bypass,
153};
154
155static int anatop_regulator_probe(struct platform_device *pdev)
156{
157	struct device *dev = &pdev->dev;
158	struct device_node *np = dev->of_node;
159	struct device_node *anatop_np;
160	struct regulator_desc *rdesc;
161	struct regulator_dev *rdev;
162	struct anatop_regulator *sreg;
163	struct regulator_init_data *initdata;
164	struct regulator_config config = { };
165	struct regmap *regmap;
166	u32 control_reg;
167	u32 vol_bit_shift;
168	u32 vol_bit_width;
169	u32 min_bit_val;
170	u32 min_voltage;
171	u32 max_voltage;
172	int ret = 0;
173	u32 val;
174
175	sreg = devm_kzalloc(dev, sizeof(*sreg), GFP_KERNEL);
176	if (!sreg)
177		return -ENOMEM;
178
179	rdesc = &sreg->rdesc;
180	rdesc->type = REGULATOR_VOLTAGE;
181	rdesc->owner = THIS_MODULE;
182
183	of_property_read_string(np, "regulator-name", &rdesc->name);
184	if (!rdesc->name) {
185		dev_err(dev, "failed to get a regulator-name\n");
186		return -EINVAL;
187	}
188
189	initdata = of_get_regulator_init_data(dev, np, rdesc);
190	if (!initdata)
191		return -ENOMEM;
192
193	initdata->supply_regulator = "vin";
 
194
195	anatop_np = of_get_parent(np);
196	if (!anatop_np)
197		return -ENODEV;
198	regmap = syscon_node_to_regmap(anatop_np);
199	of_node_put(anatop_np);
200	if (IS_ERR(regmap))
201		return PTR_ERR(regmap);
202
203	ret = of_property_read_u32(np, "anatop-reg-offset", &control_reg);
 
204	if (ret) {
205		dev_err(dev, "no anatop-reg-offset property set\n");
206		return ret;
207	}
208	ret = of_property_read_u32(np, "anatop-vol-bit-width", &vol_bit_width);
 
209	if (ret) {
210		dev_err(dev, "no anatop-vol-bit-width property set\n");
211		return ret;
212	}
213	ret = of_property_read_u32(np, "anatop-vol-bit-shift", &vol_bit_shift);
 
214	if (ret) {
215		dev_err(dev, "no anatop-vol-bit-shift property set\n");
216		return ret;
217	}
218	ret = of_property_read_u32(np, "anatop-min-bit-val", &min_bit_val);
 
219	if (ret) {
220		dev_err(dev, "no anatop-min-bit-val property set\n");
221		return ret;
222	}
223	ret = of_property_read_u32(np, "anatop-min-voltage", &min_voltage);
 
224	if (ret) {
225		dev_err(dev, "no anatop-min-voltage property set\n");
226		return ret;
227	}
228	ret = of_property_read_u32(np, "anatop-max-voltage", &max_voltage);
 
229	if (ret) {
230		dev_err(dev, "no anatop-max-voltage property set\n");
231		return ret;
232	}
233
234	/* read LDO ramp up setting, only for core reg */
235	of_property_read_u32(np, "anatop-delay-reg-offset",
236			     &sreg->delay_reg);
237	of_property_read_u32(np, "anatop-delay-bit-width",
238			     &sreg->delay_bit_width);
239	of_property_read_u32(np, "anatop-delay-bit-shift",
240			     &sreg->delay_bit_shift);
241
242	rdesc->n_voltages = (max_voltage - min_voltage) / 25000 + 1
243			    + min_bit_val;
244	rdesc->min_uV = min_voltage;
245	rdesc->uV_step = 25000;
246	rdesc->linear_min_sel = min_bit_val;
247	rdesc->vsel_reg = control_reg;
248	rdesc->vsel_mask = ((1 << vol_bit_width) - 1) << vol_bit_shift;
 
249	rdesc->min_dropout_uV = 125000;
250
251	config.dev = &pdev->dev;
252	config.init_data = initdata;
253	config.driver_data = sreg;
254	config.of_node = pdev->dev.of_node;
255	config.regmap = regmap;
256
257	/* Only core regulators have the ramp up delay configuration. */
258	if (control_reg && sreg->delay_bit_width) {
259		rdesc->ops = &anatop_core_rops;
260
261		ret = regmap_read(config.regmap, rdesc->vsel_reg, &val);
262		if (ret) {
263			dev_err(dev, "failed to read initial state\n");
264			return ret;
265		}
266
267		sreg->sel = (val & rdesc->vsel_mask) >> vol_bit_shift;
268		if (sreg->sel == LDO_FET_FULL_ON) {
269			sreg->sel = 0;
270			sreg->bypass = true;
271		}
272
273		/*
274		 * In case vddpu was disabled by the bootloader, we need to set
275		 * a sane default until imx6-cpufreq was probed and changes the
276		 * voltage to the correct value. In this case we set 1.25V.
277		 */
278		if (!sreg->sel && !strcmp(rdesc->name, "vddpu"))
279			sreg->sel = 22;
280
281		/* set the default voltage of the pcie phy to be 1.100v */
282		if (!sreg->sel && !strcmp(rdesc->name, "vddpcie"))
283			sreg->sel = 0x10;
284
285		if (!sreg->bypass && !sreg->sel) {
286			dev_err(&pdev->dev, "Failed to read a valid default voltage selector.\n");
287			return -EINVAL;
288		}
289	} else {
290		u32 enable_bit;
291
292		rdesc->ops = &anatop_rops;
293
294		if (!of_property_read_u32(np, "anatop-enable-bit",
295					  &enable_bit)) {
296			anatop_rops.enable  = regulator_enable_regmap;
297			anatop_rops.disable = regulator_disable_regmap;
298			anatop_rops.is_enabled = regulator_is_enabled_regmap;
299
300			rdesc->enable_reg = control_reg;
301			rdesc->enable_mask = BIT(enable_bit);
302		}
303	}
304
305	/* register regulator */
306	rdev = devm_regulator_register(dev, rdesc, &config);
307	if (IS_ERR(rdev)) {
308		ret = PTR_ERR(rdev);
309		if (ret == -EPROBE_DEFER)
310			dev_dbg(dev, "failed to register %s, deferring...\n",
311				rdesc->name);
312		else
313			dev_err(dev, "failed to register %s\n", rdesc->name);
314		return ret;
315	}
316
317	platform_set_drvdata(pdev, rdev);
318
319	return 0;
320}
321
322static const struct of_device_id of_anatop_regulator_match_tbl[] = {
323	{ .compatible = "fsl,anatop-regulator", },
324	{ /* end */ }
325};
326MODULE_DEVICE_TABLE(of, of_anatop_regulator_match_tbl);
327
328static struct platform_driver anatop_regulator_driver = {
329	.driver = {
330		.name	= "anatop_regulator",
331		.probe_type = PROBE_PREFER_ASYNCHRONOUS,
332		.of_match_table = of_anatop_regulator_match_tbl,
333	},
334	.probe	= anatop_regulator_probe,
335};
336
337static int __init anatop_regulator_init(void)
338{
339	return platform_driver_register(&anatop_regulator_driver);
340}
341postcore_initcall(anatop_regulator_init);
342
343static void __exit anatop_regulator_exit(void)
344{
345	platform_driver_unregister(&anatop_regulator_driver);
346}
347module_exit(anatop_regulator_exit);
348
349MODULE_AUTHOR("Nancy Chen <Nancy.Chen@freescale.com>");
350MODULE_AUTHOR("Ying-Chun Liu (PaulLiu) <paul.liu@linaro.org>");
351MODULE_DESCRIPTION("ANATOP Regulator driver");
352MODULE_LICENSE("GPL v2");
353MODULE_ALIAS("platform:anatop_regulator");
v4.17
  1/*
  2 * Copyright (C) 2011 Freescale Semiconductor, Inc. All Rights Reserved.
  3 */
  4
  5/*
  6 * This program is free software; you can redistribute it and/or modify
  7 * it under the terms of the GNU General Public License as published by
  8 * the Free Software Foundation; either version 2 of the License, or
  9 * (at your option) any later version.
 10
 11 * This program is distributed in the hope that it will be useful,
 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 14 * GNU General Public License for more details.
 15
 16 * You should have received a copy of the GNU General Public License along
 17 * with this program; if not, write to the Free Software Foundation, Inc.,
 18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 19 */
 20
 21#include <linux/slab.h>
 22#include <linux/device.h>
 23#include <linux/module.h>
 24#include <linux/mfd/syscon.h>
 25#include <linux/err.h>
 26#include <linux/io.h>
 27#include <linux/platform_device.h>
 28#include <linux/of.h>
 29#include <linux/of_address.h>
 30#include <linux/regmap.h>
 31#include <linux/regulator/driver.h>
 32#include <linux/regulator/of_regulator.h>
 33#include <linux/regulator/machine.h>
 34
 35#define LDO_RAMP_UP_UNIT_IN_CYCLES      64 /* 64 cycles per step */
 36#define LDO_RAMP_UP_FREQ_IN_MHZ         24 /* cycle based on 24M OSC */
 37
 38#define LDO_POWER_GATE			0x00
 39#define LDO_FET_FULL_ON			0x1f
 40
 41struct anatop_regulator {
 42	u32 control_reg;
 43	struct regmap *anatop;
 44	int vol_bit_shift;
 45	int vol_bit_width;
 46	u32 delay_reg;
 47	int delay_bit_shift;
 48	int delay_bit_width;
 49	int min_bit_val;
 50	int min_voltage;
 51	int max_voltage;
 52	struct regulator_desc rdesc;
 53	struct regulator_init_data *initdata;
 54	bool bypass;
 55	int sel;
 56};
 57
 58static int anatop_regmap_set_voltage_time_sel(struct regulator_dev *reg,
 59	unsigned int old_sel,
 60	unsigned int new_sel)
 61{
 62	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
 63	u32 val;
 64	int ret = 0;
 65
 66	/* check whether need to care about LDO ramp up speed */
 67	if (anatop_reg->delay_bit_width && new_sel > old_sel) {
 68		/*
 69		 * the delay for LDO ramp up time is
 70		 * based on the register setting, we need
 71		 * to calculate how many steps LDO need to
 72		 * ramp up, and how much delay needed. (us)
 73		 */
 74		regmap_read(anatop_reg->anatop, anatop_reg->delay_reg, &val);
 75		val = (val >> anatop_reg->delay_bit_shift) &
 76			((1 << anatop_reg->delay_bit_width) - 1);
 77		ret = (new_sel - old_sel) * (LDO_RAMP_UP_UNIT_IN_CYCLES <<
 78			val) / LDO_RAMP_UP_FREQ_IN_MHZ + 1;
 79	}
 80
 81	return ret;
 82}
 83
 84static int anatop_regmap_enable(struct regulator_dev *reg)
 85{
 86	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
 87	int sel;
 88
 89	sel = anatop_reg->bypass ? LDO_FET_FULL_ON : anatop_reg->sel;
 90	return regulator_set_voltage_sel_regmap(reg, sel);
 91}
 92
 93static int anatop_regmap_disable(struct regulator_dev *reg)
 94{
 95	return regulator_set_voltage_sel_regmap(reg, LDO_POWER_GATE);
 96}
 97
 98static int anatop_regmap_is_enabled(struct regulator_dev *reg)
 99{
100	return regulator_get_voltage_sel_regmap(reg) != LDO_POWER_GATE;
101}
102
103static int anatop_regmap_core_set_voltage_sel(struct regulator_dev *reg,
104					      unsigned selector)
105{
106	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
107	int ret;
108
109	if (anatop_reg->bypass || !anatop_regmap_is_enabled(reg)) {
110		anatop_reg->sel = selector;
111		return 0;
112	}
113
114	ret = regulator_set_voltage_sel_regmap(reg, selector);
115	if (!ret)
116		anatop_reg->sel = selector;
117	return ret;
118}
119
120static int anatop_regmap_core_get_voltage_sel(struct regulator_dev *reg)
121{
122	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
123
124	if (anatop_reg->bypass || !anatop_regmap_is_enabled(reg))
125		return anatop_reg->sel;
126
127	return regulator_get_voltage_sel_regmap(reg);
128}
129
130static int anatop_regmap_get_bypass(struct regulator_dev *reg, bool *enable)
131{
132	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
133	int sel;
134
135	sel = regulator_get_voltage_sel_regmap(reg);
136	if (sel == LDO_FET_FULL_ON)
137		WARN_ON(!anatop_reg->bypass);
138	else if (sel != LDO_POWER_GATE)
139		WARN_ON(anatop_reg->bypass);
140
141	*enable = anatop_reg->bypass;
142	return 0;
143}
144
145static int anatop_regmap_set_bypass(struct regulator_dev *reg, bool enable)
146{
147	struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg);
148	int sel;
149
150	if (enable == anatop_reg->bypass)
151		return 0;
152
153	sel = enable ? LDO_FET_FULL_ON : anatop_reg->sel;
154	anatop_reg->bypass = enable;
155
156	return regulator_set_voltage_sel_regmap(reg, sel);
157}
158
159static struct regulator_ops anatop_rops = {
160	.set_voltage_sel = regulator_set_voltage_sel_regmap,
161	.get_voltage_sel = regulator_get_voltage_sel_regmap,
162	.list_voltage = regulator_list_voltage_linear,
163	.map_voltage = regulator_map_voltage_linear,
164};
165
166static struct regulator_ops anatop_core_rops = {
167	.enable = anatop_regmap_enable,
168	.disable = anatop_regmap_disable,
169	.is_enabled = anatop_regmap_is_enabled,
170	.set_voltage_sel = anatop_regmap_core_set_voltage_sel,
171	.set_voltage_time_sel = anatop_regmap_set_voltage_time_sel,
172	.get_voltage_sel = anatop_regmap_core_get_voltage_sel,
173	.list_voltage = regulator_list_voltage_linear,
174	.map_voltage = regulator_map_voltage_linear,
175	.get_bypass = anatop_regmap_get_bypass,
176	.set_bypass = anatop_regmap_set_bypass,
177};
178
179static int anatop_regulator_probe(struct platform_device *pdev)
180{
181	struct device *dev = &pdev->dev;
182	struct device_node *np = dev->of_node;
183	struct device_node *anatop_np;
184	struct regulator_desc *rdesc;
185	struct regulator_dev *rdev;
186	struct anatop_regulator *sreg;
187	struct regulator_init_data *initdata;
188	struct regulator_config config = { };
 
 
 
 
 
 
 
189	int ret = 0;
190	u32 val;
191
192	sreg = devm_kzalloc(dev, sizeof(*sreg), GFP_KERNEL);
193	if (!sreg)
194		return -ENOMEM;
195
196	rdesc = &sreg->rdesc;
197	rdesc->type = REGULATOR_VOLTAGE;
198	rdesc->owner = THIS_MODULE;
199
200	of_property_read_string(np, "regulator-name", &rdesc->name);
201	if (!rdesc->name) {
202		dev_err(dev, "failed to get a regulator-name\n");
203		return -EINVAL;
204	}
205
206	initdata = of_get_regulator_init_data(dev, np, rdesc);
207	if (!initdata)
208		return -ENOMEM;
209
210	initdata->supply_regulator = "vin";
211	sreg->initdata = initdata;
212
213	anatop_np = of_get_parent(np);
214	if (!anatop_np)
215		return -ENODEV;
216	sreg->anatop = syscon_node_to_regmap(anatop_np);
217	of_node_put(anatop_np);
218	if (IS_ERR(sreg->anatop))
219		return PTR_ERR(sreg->anatop);
220
221	ret = of_property_read_u32(np, "anatop-reg-offset",
222				   &sreg->control_reg);
223	if (ret) {
224		dev_err(dev, "no anatop-reg-offset property set\n");
225		return ret;
226	}
227	ret = of_property_read_u32(np, "anatop-vol-bit-width",
228				   &sreg->vol_bit_width);
229	if (ret) {
230		dev_err(dev, "no anatop-vol-bit-width property set\n");
231		return ret;
232	}
233	ret = of_property_read_u32(np, "anatop-vol-bit-shift",
234				   &sreg->vol_bit_shift);
235	if (ret) {
236		dev_err(dev, "no anatop-vol-bit-shift property set\n");
237		return ret;
238	}
239	ret = of_property_read_u32(np, "anatop-min-bit-val",
240				   &sreg->min_bit_val);
241	if (ret) {
242		dev_err(dev, "no anatop-min-bit-val property set\n");
243		return ret;
244	}
245	ret = of_property_read_u32(np, "anatop-min-voltage",
246				   &sreg->min_voltage);
247	if (ret) {
248		dev_err(dev, "no anatop-min-voltage property set\n");
249		return ret;
250	}
251	ret = of_property_read_u32(np, "anatop-max-voltage",
252				   &sreg->max_voltage);
253	if (ret) {
254		dev_err(dev, "no anatop-max-voltage property set\n");
255		return ret;
256	}
257
258	/* read LDO ramp up setting, only for core reg */
259	of_property_read_u32(np, "anatop-delay-reg-offset",
260			     &sreg->delay_reg);
261	of_property_read_u32(np, "anatop-delay-bit-width",
262			     &sreg->delay_bit_width);
263	of_property_read_u32(np, "anatop-delay-bit-shift",
264			     &sreg->delay_bit_shift);
265
266	rdesc->n_voltages = (sreg->max_voltage - sreg->min_voltage) / 25000 + 1
267			    + sreg->min_bit_val;
268	rdesc->min_uV = sreg->min_voltage;
269	rdesc->uV_step = 25000;
270	rdesc->linear_min_sel = sreg->min_bit_val;
271	rdesc->vsel_reg = sreg->control_reg;
272	rdesc->vsel_mask = ((1 << sreg->vol_bit_width) - 1) <<
273			   sreg->vol_bit_shift;
274	rdesc->min_dropout_uV = 125000;
275
276	config.dev = &pdev->dev;
277	config.init_data = initdata;
278	config.driver_data = sreg;
279	config.of_node = pdev->dev.of_node;
280	config.regmap = sreg->anatop;
281
282	/* Only core regulators have the ramp up delay configuration. */
283	if (sreg->control_reg && sreg->delay_bit_width) {
284		rdesc->ops = &anatop_core_rops;
285
286		ret = regmap_read(config.regmap, rdesc->vsel_reg, &val);
287		if (ret) {
288			dev_err(dev, "failed to read initial state\n");
289			return ret;
290		}
291
292		sreg->sel = (val & rdesc->vsel_mask) >> sreg->vol_bit_shift;
293		if (sreg->sel == LDO_FET_FULL_ON) {
294			sreg->sel = 0;
295			sreg->bypass = true;
296		}
297
298		/*
299		 * In case vddpu was disabled by the bootloader, we need to set
300		 * a sane default until imx6-cpufreq was probed and changes the
301		 * voltage to the correct value. In this case we set 1.25V.
302		 */
303		if (!sreg->sel && !strcmp(rdesc->name, "vddpu"))
304			sreg->sel = 22;
305
306		/* set the default voltage of the pcie phy to be 1.100v */
307		if (!sreg->sel && !strcmp(rdesc->name, "vddpcie"))
308			sreg->sel = 0x10;
309
310		if (!sreg->bypass && !sreg->sel) {
311			dev_err(&pdev->dev, "Failed to read a valid default voltage selector.\n");
312			return -EINVAL;
313		}
314	} else {
315		u32 enable_bit;
316
317		rdesc->ops = &anatop_rops;
318
319		if (!of_property_read_u32(np, "anatop-enable-bit",
320					  &enable_bit)) {
321			anatop_rops.enable  = regulator_enable_regmap;
322			anatop_rops.disable = regulator_disable_regmap;
323			anatop_rops.is_enabled = regulator_is_enabled_regmap;
324
325			rdesc->enable_reg = sreg->control_reg;
326			rdesc->enable_mask = BIT(enable_bit);
327		}
328	}
329
330	/* register regulator */
331	rdev = devm_regulator_register(dev, rdesc, &config);
332	if (IS_ERR(rdev)) {
333		dev_err(dev, "failed to register %s\n",
334			rdesc->name);
335		return PTR_ERR(rdev);
 
 
 
 
336	}
337
338	platform_set_drvdata(pdev, rdev);
339
340	return 0;
341}
342
343static const struct of_device_id of_anatop_regulator_match_tbl[] = {
344	{ .compatible = "fsl,anatop-regulator", },
345	{ /* end */ }
346};
347MODULE_DEVICE_TABLE(of, of_anatop_regulator_match_tbl);
348
349static struct platform_driver anatop_regulator_driver = {
350	.driver = {
351		.name	= "anatop_regulator",
 
352		.of_match_table = of_anatop_regulator_match_tbl,
353	},
354	.probe	= anatop_regulator_probe,
355};
356
357static int __init anatop_regulator_init(void)
358{
359	return platform_driver_register(&anatop_regulator_driver);
360}
361postcore_initcall(anatop_regulator_init);
362
363static void __exit anatop_regulator_exit(void)
364{
365	platform_driver_unregister(&anatop_regulator_driver);
366}
367module_exit(anatop_regulator_exit);
368
369MODULE_AUTHOR("Nancy Chen <Nancy.Chen@freescale.com>");
370MODULE_AUTHOR("Ying-Chun Liu (PaulLiu) <paul.liu@linaro.org>");
371MODULE_DESCRIPTION("ANATOP Regulator driver");
372MODULE_LICENSE("GPL v2");
373MODULE_ALIAS("platform:anatop_regulator");