1 /*
2  * Regulators driver for Dialog Semiconductor DA903x
3  *
4  * Copyright (C) 2006-2008 Marvell International Ltd.
5  * Copyright (C) 2008 Compulab Ltd.
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11 
12 #include <linux/kernel.h>
13 #include <linux/init.h>
14 #include <linux/err.h>
15 #include <linux/module.h>
16 #include <linux/platform_device.h>
17 #include <linux/regulator/driver.h>
18 #include <linux/regulator/machine.h>
19 #include <linux/mfd/da903x.h>
20 
21 /* DA9030 Registers */
22 #define DA9030_INVAL		(-1)
23 #define DA9030_LDO1011		(0x10)
24 #define DA9030_LDO15		(0x11)
25 #define DA9030_LDO1416		(0x12)
26 #define DA9030_LDO1819		(0x13)
27 #define DA9030_LDO17		(0x14)
28 #define DA9030_BUCK2DVM1	(0x15)
29 #define DA9030_BUCK2DVM2	(0x16)
30 #define DA9030_RCTL11		(0x17)
31 #define DA9030_RCTL21		(0x18)
32 #define DA9030_LDO1		(0x90)
33 #define DA9030_LDO23		(0x91)
34 #define DA9030_LDO45		(0x92)
35 #define DA9030_LDO6		(0x93)
36 #define DA9030_LDO78		(0x94)
37 #define DA9030_LDO912		(0x95)
38 #define DA9030_BUCK		(0x96)
39 #define DA9030_RCTL12		(0x97)
40 #define DA9030_RCTL22		(0x98)
41 #define DA9030_LDO_UNLOCK	(0xa0)
42 #define DA9030_LDO_UNLOCK_MASK	(0xe0)
43 #define DA9034_OVER1		(0x10)
44 
45 /* DA9034 Registers */
46 #define DA9034_INVAL		(-1)
47 #define DA9034_OVER2		(0x11)
48 #define DA9034_OVER3		(0x12)
49 #define DA9034_LDO643		(0x13)
50 #define DA9034_LDO987		(0x14)
51 #define DA9034_LDO1110		(0x15)
52 #define DA9034_LDO1312		(0x16)
53 #define DA9034_LDO1514		(0x17)
54 #define DA9034_VCC1		(0x20)
55 #define DA9034_ADTV1		(0x23)
56 #define DA9034_ADTV2		(0x24)
57 #define DA9034_AVRC		(0x25)
58 #define DA9034_CDTV1		(0x26)
59 #define DA9034_CDTV2		(0x27)
60 #define DA9034_CVRC		(0x28)
61 #define DA9034_SDTV1		(0x29)
62 #define DA9034_SDTV2		(0x2a)
63 #define DA9034_SVRC		(0x2b)
64 #define DA9034_MDTV1		(0x32)
65 #define DA9034_MDTV2		(0x33)
66 #define DA9034_MVRC		(0x34)
67 
68 /* DA9035 Registers. DA9034 Registers are comptabile to DA9035. */
69 #define DA9035_OVER3		(0x12)
70 #define DA9035_VCC2		(0x1f)
71 #define DA9035_3DTV1		(0x2c)
72 #define DA9035_3DTV2		(0x2d)
73 #define DA9035_3VRC		(0x2e)
74 #define DA9035_AUTOSKIP		(0x2f)
75 
76 struct da903x_regulator_info {
77 	struct regulator_desc desc;
78 
79 	int	min_uV;
80 	int	max_uV;
81 	int	step_uV;
82 	int	vol_reg;
83 	int	vol_shift;
84 	int	vol_nbits;
85 	int	update_reg;
86 	int	update_bit;
87 	int	enable_reg;
88 	int	enable_bit;
89 };
90 
91 static int da9034_ldo12_data[] = { 1700, 1750, 1800, 1850, 1900, 1950,
92 				   2000, 2050, 2700, 2750, 2800, 2850,
93 				   2900, 2950, 3000, 3050 };
94 
to_da903x_dev(struct regulator_dev * rdev)95 static inline struct device *to_da903x_dev(struct regulator_dev *rdev)
96 {
97 	return rdev_get_dev(rdev)->parent->parent;
98 }
99 
check_range(struct da903x_regulator_info * info,int min_uV,int max_uV)100 static inline int check_range(struct da903x_regulator_info *info,
101 				int min_uV, int max_uV)
102 {
103 	if (min_uV < info->min_uV || min_uV > info->max_uV)
104 		return -EINVAL;
105 
106 	return 0;
107 }
108 
109 /* DA9030/DA9034 common operations */
da903x_set_ldo_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)110 static int da903x_set_ldo_voltage(struct regulator_dev *rdev,
111 				  int min_uV, int max_uV, unsigned *selector)
112 {
113 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
114 	struct device *da9034_dev = to_da903x_dev(rdev);
115 	uint8_t val, mask;
116 
117 	if (check_range(info, min_uV, max_uV)) {
118 		pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
119 		return -EINVAL;
120 	}
121 
122 	val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
123 	*selector = val;
124 	val <<= info->vol_shift;
125 	mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
126 
127 	return da903x_update(da9034_dev, info->vol_reg, val, mask);
128 }
129 
da903x_get_voltage(struct regulator_dev * rdev)130 static int da903x_get_voltage(struct regulator_dev *rdev)
131 {
132 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
133 	struct device *da9034_dev = to_da903x_dev(rdev);
134 	uint8_t val, mask;
135 	int ret;
136 
137 	ret = da903x_read(da9034_dev, info->vol_reg, &val);
138 	if (ret)
139 		return ret;
140 
141 	mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
142 	val = (val & mask) >> info->vol_shift;
143 
144 	return info->min_uV + info->step_uV * val;
145 }
146 
da903x_enable(struct regulator_dev * rdev)147 static int da903x_enable(struct regulator_dev *rdev)
148 {
149 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
150 	struct device *da9034_dev = to_da903x_dev(rdev);
151 
152 	return da903x_set_bits(da9034_dev, info->enable_reg,
153 					1 << info->enable_bit);
154 }
155 
da903x_disable(struct regulator_dev * rdev)156 static int da903x_disable(struct regulator_dev *rdev)
157 {
158 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
159 	struct device *da9034_dev = to_da903x_dev(rdev);
160 
161 	return da903x_clr_bits(da9034_dev, info->enable_reg,
162 					1 << info->enable_bit);
163 }
164 
da903x_is_enabled(struct regulator_dev * rdev)165 static int da903x_is_enabled(struct regulator_dev *rdev)
166 {
167 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
168 	struct device *da9034_dev = to_da903x_dev(rdev);
169 	uint8_t reg_val;
170 	int ret;
171 
172 	ret = da903x_read(da9034_dev, info->enable_reg, &reg_val);
173 	if (ret)
174 		return ret;
175 
176 	return !!(reg_val & (1 << info->enable_bit));
177 }
178 
da903x_list_voltage(struct regulator_dev * rdev,unsigned selector)179 static int da903x_list_voltage(struct regulator_dev *rdev, unsigned selector)
180 {
181 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
182 	int ret;
183 
184 	ret = info->min_uV + info->step_uV * selector;
185 	if (ret > info->max_uV)
186 		return -EINVAL;
187 	return ret;
188 }
189 
190 /* DA9030 specific operations */
da9030_set_ldo1_15_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)191 static int da9030_set_ldo1_15_voltage(struct regulator_dev *rdev,
192 				      int min_uV, int max_uV,
193 				      unsigned *selector)
194 {
195 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
196 	struct device *da903x_dev = to_da903x_dev(rdev);
197 	uint8_t val, mask;
198 	int ret;
199 
200 	if (check_range(info, min_uV, max_uV)) {
201 		pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
202 		return -EINVAL;
203 	}
204 
205 	val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
206 	*selector = val;
207 	val <<= info->vol_shift;
208 	mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
209 	val |= DA9030_LDO_UNLOCK; /* have to set UNLOCK bits */
210 	mask |= DA9030_LDO_UNLOCK_MASK;
211 
212 	/* write twice */
213 	ret = da903x_update(da903x_dev, info->vol_reg, val, mask);
214 	if (ret)
215 		return ret;
216 
217 	return da903x_update(da903x_dev, info->vol_reg, val, mask);
218 }
219 
da9030_set_ldo14_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)220 static int da9030_set_ldo14_voltage(struct regulator_dev *rdev,
221 				    int min_uV, int max_uV,
222 				    unsigned *selector)
223 {
224 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
225 	struct device *da903x_dev = to_da903x_dev(rdev);
226 	uint8_t val, mask;
227 	int thresh;
228 
229 	if (check_range(info, min_uV, max_uV)) {
230 		pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
231 		return -EINVAL;
232 	}
233 
234 	thresh = (info->max_uV + info->min_uV) / 2;
235 	if (min_uV < thresh) {
236 		val = (thresh - min_uV + info->step_uV - 1) / info->step_uV;
237 		val |= 0x4;
238 	} else {
239 		val = (min_uV - thresh + info->step_uV - 1) / info->step_uV;
240 	}
241 
242 	*selector = val;
243 	val <<= info->vol_shift;
244 	mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
245 
246 	return da903x_update(da903x_dev, info->vol_reg, val, mask);
247 }
248 
da9030_get_ldo14_voltage(struct regulator_dev * rdev)249 static int da9030_get_ldo14_voltage(struct regulator_dev *rdev)
250 {
251 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
252 	struct device *da903x_dev = to_da903x_dev(rdev);
253 	uint8_t val, mask;
254 	int ret;
255 
256 	ret = da903x_read(da903x_dev, info->vol_reg, &val);
257 	if (ret)
258 		return ret;
259 
260 	mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
261 	val = (val & mask) >> info->vol_shift;
262 
263 	if (val & 0x4)
264 		return info->min_uV + info->step_uV * (3 - (val & ~0x4));
265 	else
266 		return (info->max_uV + info->min_uV) / 2 +
267 			info->step_uV * (val & ~0x4);
268 }
269 
270 /* DA9034 specific operations */
da9034_set_dvc_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)271 static int da9034_set_dvc_voltage(struct regulator_dev *rdev,
272 				  int min_uV, int max_uV, unsigned *selector)
273 {
274 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
275 	struct device *da9034_dev = to_da903x_dev(rdev);
276 	uint8_t val, mask;
277 	int ret;
278 
279 	if (check_range(info, min_uV, max_uV)) {
280 		pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
281 		return -EINVAL;
282 	}
283 
284 	val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
285 	*selector = val;
286 	val <<= info->vol_shift;
287 	mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
288 
289 	ret = da903x_update(da9034_dev, info->vol_reg, val, mask);
290 	if (ret)
291 		return ret;
292 
293 	ret = da903x_set_bits(da9034_dev, info->update_reg,
294 					1 << info->update_bit);
295 	return ret;
296 }
297 
da9034_set_ldo12_voltage(struct regulator_dev * rdev,int min_uV,int max_uV,unsigned * selector)298 static int da9034_set_ldo12_voltage(struct regulator_dev *rdev,
299 				    int min_uV, int max_uV, unsigned *selector)
300 {
301 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
302 	struct device *da9034_dev = to_da903x_dev(rdev);
303 	uint8_t val, mask;
304 
305 	if (check_range(info, min_uV, max_uV)) {
306 		pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
307 		return -EINVAL;
308 	}
309 
310 	val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
311 	val = (val >= 20) ? val - 12 : ((val > 7) ? 8 : val);
312 	*selector = val;
313 	val <<= info->vol_shift;
314 	mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
315 
316 	return da903x_update(da9034_dev, info->vol_reg, val, mask);
317 }
318 
da9034_get_ldo12_voltage(struct regulator_dev * rdev)319 static int da9034_get_ldo12_voltage(struct regulator_dev *rdev)
320 {
321 	struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
322 	struct device *da9034_dev = to_da903x_dev(rdev);
323 	uint8_t val, mask;
324 	int ret;
325 
326 	ret = da903x_read(da9034_dev, info->vol_reg, &val);
327 	if (ret)
328 		return ret;
329 
330 	mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
331 	val = (val & mask) >> info->vol_shift;
332 
333 	if (val >= 8)
334 		return 2700000 + info->step_uV * (val - 8);
335 
336 	return info->min_uV + info->step_uV * val;
337 }
338 
da9034_list_ldo12_voltage(struct regulator_dev * rdev,unsigned selector)339 static int da9034_list_ldo12_voltage(struct regulator_dev *rdev,
340 				     unsigned selector)
341 {
342 	if (selector >= ARRAY_SIZE(da9034_ldo12_data))
343 		return -EINVAL;
344 	return da9034_ldo12_data[selector] * 1000;
345 }
346 
347 static struct regulator_ops da903x_regulator_ldo_ops = {
348 	.set_voltage	= da903x_set_ldo_voltage,
349 	.get_voltage	= da903x_get_voltage,
350 	.list_voltage	= da903x_list_voltage,
351 	.enable		= da903x_enable,
352 	.disable	= da903x_disable,
353 	.is_enabled	= da903x_is_enabled,
354 };
355 
356 /* NOTE: this is dedicated for the insane DA9030 LDO14 */
357 static struct regulator_ops da9030_regulator_ldo14_ops = {
358 	.set_voltage	= da9030_set_ldo14_voltage,
359 	.get_voltage	= da9030_get_ldo14_voltage,
360 	.list_voltage	= da903x_list_voltage,
361 	.enable		= da903x_enable,
362 	.disable	= da903x_disable,
363 	.is_enabled	= da903x_is_enabled,
364 };
365 
366 /* NOTE: this is dedicated for the DA9030 LDO1 and LDO15 that have locks  */
367 static struct regulator_ops da9030_regulator_ldo1_15_ops = {
368 	.set_voltage	= da9030_set_ldo1_15_voltage,
369 	.get_voltage	= da903x_get_voltage,
370 	.list_voltage	= da903x_list_voltage,
371 	.enable		= da903x_enable,
372 	.disable	= da903x_disable,
373 	.is_enabled	= da903x_is_enabled,
374 };
375 
376 static struct regulator_ops da9034_regulator_dvc_ops = {
377 	.set_voltage	= da9034_set_dvc_voltage,
378 	.get_voltage	= da903x_get_voltage,
379 	.list_voltage	= da903x_list_voltage,
380 	.enable		= da903x_enable,
381 	.disable	= da903x_disable,
382 	.is_enabled	= da903x_is_enabled,
383 };
384 
385 /* NOTE: this is dedicated for the insane LDO12 */
386 static struct regulator_ops da9034_regulator_ldo12_ops = {
387 	.set_voltage	= da9034_set_ldo12_voltage,
388 	.get_voltage	= da9034_get_ldo12_voltage,
389 	.list_voltage	= da9034_list_ldo12_voltage,
390 	.enable		= da903x_enable,
391 	.disable	= da903x_disable,
392 	.is_enabled	= da903x_is_enabled,
393 };
394 
395 #define DA903x_LDO(_pmic, _id, min, max, step, vreg, shift, nbits, ereg, ebit)	\
396 {									\
397 	.desc	= {							\
398 		.name	= "LDO" #_id,					\
399 		.ops	= &da903x_regulator_ldo_ops,			\
400 		.type	= REGULATOR_VOLTAGE,				\
401 		.id	= _pmic##_ID_LDO##_id,				\
402 		.n_voltages = (step) ? ((max - min) / step + 1) : 1,	\
403 		.owner	= THIS_MODULE,					\
404 	},								\
405 	.min_uV		= (min) * 1000,					\
406 	.max_uV		= (max) * 1000,					\
407 	.step_uV	= (step) * 1000,				\
408 	.vol_reg	= _pmic##_##vreg,				\
409 	.vol_shift	= (shift),					\
410 	.vol_nbits	= (nbits),					\
411 	.enable_reg	= _pmic##_##ereg,				\
412 	.enable_bit	= (ebit),					\
413 }
414 
415 #define DA903x_DVC(_pmic, _id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
416 {									\
417 	.desc	= {							\
418 		.name	= #_id,						\
419 		.ops	= &da9034_regulator_dvc_ops,			\
420 		.type	= REGULATOR_VOLTAGE,				\
421 		.id	= _pmic##_ID_##_id,				\
422 		.n_voltages = (step) ? ((max - min) / step + 1) : 1,	\
423 		.owner	= THIS_MODULE,					\
424 	},								\
425 	.min_uV		= (min) * 1000,					\
426 	.max_uV		= (max) * 1000,					\
427 	.step_uV	= (step) * 1000,				\
428 	.vol_reg	= _pmic##_##vreg,				\
429 	.vol_shift	= (0),						\
430 	.vol_nbits	= (nbits),					\
431 	.update_reg	= _pmic##_##ureg,				\
432 	.update_bit	= (ubit),					\
433 	.enable_reg	= _pmic##_##ereg,				\
434 	.enable_bit	= (ebit),					\
435 }
436 
437 #define DA9034_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit)	\
438 	DA903x_LDO(DA9034, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
439 
440 #define DA9030_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit)	\
441 	DA903x_LDO(DA9030, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
442 
443 #define DA9030_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
444 	DA903x_DVC(DA9030, _id, min, max, step, vreg, nbits, ureg, ubit, \
445 		   ereg, ebit)
446 
447 #define DA9034_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
448 	DA903x_DVC(DA9034, _id, min, max, step, vreg, nbits, ureg, ubit, \
449 		   ereg, ebit)
450 
451 #define DA9035_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
452 	DA903x_DVC(DA9035, _id, min, max, step, vreg, nbits, ureg, ubit, \
453 		   ereg, ebit)
454 
455 static struct da903x_regulator_info da903x_regulator_info[] = {
456 	/* DA9030 */
457 	DA9030_DVC(BUCK2, 850, 1625, 25, BUCK2DVM1, 5, BUCK2DVM1, 7, RCTL11, 0),
458 
459 	DA9030_LDO( 1, 1200, 3200, 100,    LDO1, 0, 5, RCTL12, 1),
460 	DA9030_LDO( 2, 1800, 3200, 100,   LDO23, 0, 4, RCTL12, 2),
461 	DA9030_LDO( 3, 1800, 3200, 100,   LDO23, 4, 4, RCTL12, 3),
462 	DA9030_LDO( 4, 1800, 3200, 100,   LDO45, 0, 4, RCTL12, 4),
463 	DA9030_LDO( 5, 1800, 3200, 100,   LDO45, 4, 4, RCTL12, 5),
464 	DA9030_LDO( 6, 1800, 3200, 100,    LDO6, 0, 4, RCTL12, 6),
465 	DA9030_LDO( 7, 1800, 3200, 100,   LDO78, 0, 4, RCTL12, 7),
466 	DA9030_LDO( 8, 1800, 3200, 100,   LDO78, 4, 4, RCTL22, 0),
467 	DA9030_LDO( 9, 1800, 3200, 100,  LDO912, 0, 4, RCTL22, 1),
468 	DA9030_LDO(10, 1800, 3200, 100, LDO1011, 0, 4, RCTL22, 2),
469 	DA9030_LDO(11, 1800, 3200, 100, LDO1011, 4, 4, RCTL22, 3),
470 	DA9030_LDO(12, 1800, 3200, 100,  LDO912, 4, 4, RCTL22, 4),
471 	DA9030_LDO(14, 2760, 2940,  30, LDO1416, 0, 3, RCTL11, 4),
472 	DA9030_LDO(15, 1100, 2650,  50,	  LDO15, 0, 5, RCTL11, 5),
473 	DA9030_LDO(16, 1100, 2650,  50, LDO1416, 3, 5, RCTL11, 6),
474 	DA9030_LDO(17, 1800, 3200, 100,   LDO17, 0, 4, RCTL11, 7),
475 	DA9030_LDO(18, 1800, 3200, 100, LDO1819, 0, 4, RCTL21, 2),
476 	DA9030_LDO(19, 1800, 3200, 100, LDO1819, 4, 4, RCTL21, 1),
477 	DA9030_LDO(13, 2100, 2100, 0, INVAL, 0, 0, RCTL11, 3), /* fixed @2.1V */
478 
479 	/* DA9034 */
480 	DA9034_DVC(BUCK1, 725, 1500, 25, ADTV2, 5, VCC1, 0, OVER1, 0),
481 	DA9034_DVC(BUCK2, 725, 1500, 25, CDTV2, 5, VCC1, 2, OVER1, 1),
482 	DA9034_DVC(LDO2,  725, 1500, 25, SDTV2, 5, VCC1, 4, OVER1, 2),
483 	DA9034_DVC(LDO1, 1700, 2075, 25, MDTV1, 4, VCC1, 6, OVER3, 4),
484 
485 	DA9034_LDO( 3, 1800, 3300, 100,  LDO643, 0, 4, OVER3, 5),
486 	DA9034_LDO( 4, 1800, 2900,1100,  LDO643, 4, 1, OVER3, 6),
487 	DA9034_LDO( 6, 2500, 2850,  50,  LDO643, 5, 3, OVER2, 0),
488 	DA9034_LDO( 7, 2700, 3050,  50,  LDO987, 0, 3, OVER2, 1),
489 	DA9034_LDO( 8, 2700, 2850,  50,  LDO987, 3, 2, OVER2, 2),
490 	DA9034_LDO( 9, 2700, 3050,  50,  LDO987, 5, 3, OVER2, 3),
491 	DA9034_LDO(10, 2700, 3050,  50, LDO1110, 0, 3, OVER2, 4),
492 	DA9034_LDO(11, 1800, 3300, 100, LDO1110, 4, 4, OVER2, 5),
493 	DA9034_LDO(12, 1700, 3050,  50, LDO1312, 0, 4, OVER3, 6),
494 	DA9034_LDO(13, 1800, 3300, 100, LDO1312, 4, 4, OVER2, 7),
495 	DA9034_LDO(14, 1800, 3300, 100, LDO1514, 0, 4, OVER3, 0),
496 	DA9034_LDO(15, 1800, 3300, 100, LDO1514, 4, 4, OVER3, 1),
497 	DA9034_LDO(5, 3100, 3100, 0, INVAL, 0, 0, OVER3, 7), /* fixed @3.1V */
498 
499 	/* DA9035 */
500 	DA9035_DVC(BUCK3, 1800, 2200, 100, 3DTV1, 3, VCC2, 0, OVER3, 3),
501 };
502 
find_regulator_info(int id)503 static inline struct da903x_regulator_info *find_regulator_info(int id)
504 {
505 	struct da903x_regulator_info *ri;
506 	int i;
507 
508 	for (i = 0; i < ARRAY_SIZE(da903x_regulator_info); i++) {
509 		ri = &da903x_regulator_info[i];
510 		if (ri->desc.id == id)
511 			return ri;
512 	}
513 	return NULL;
514 }
515 
da903x_regulator_probe(struct platform_device * pdev)516 static int __devinit da903x_regulator_probe(struct platform_device *pdev)
517 {
518 	struct da903x_regulator_info *ri = NULL;
519 	struct regulator_dev *rdev;
520 
521 	ri = find_regulator_info(pdev->id);
522 	if (ri == NULL) {
523 		dev_err(&pdev->dev, "invalid regulator ID specified\n");
524 		return -EINVAL;
525 	}
526 
527 	/* Workaround for the weird LDO12 voltage setting */
528 	if (ri->desc.id == DA9034_ID_LDO12) {
529 		ri->desc.ops = &da9034_regulator_ldo12_ops;
530 		ri->desc.n_voltages = ARRAY_SIZE(da9034_ldo12_data);
531 	}
532 
533 	if (ri->desc.id == DA9030_ID_LDO14)
534 		ri->desc.ops = &da9030_regulator_ldo14_ops;
535 
536 	if (ri->desc.id == DA9030_ID_LDO1 || ri->desc.id == DA9030_ID_LDO15)
537 		ri->desc.ops = &da9030_regulator_ldo1_15_ops;
538 
539 	rdev = regulator_register(&ri->desc, &pdev->dev,
540 				  pdev->dev.platform_data, ri, NULL);
541 	if (IS_ERR(rdev)) {
542 		dev_err(&pdev->dev, "failed to register regulator %s\n",
543 				ri->desc.name);
544 		return PTR_ERR(rdev);
545 	}
546 
547 	platform_set_drvdata(pdev, rdev);
548 	return 0;
549 }
550 
da903x_regulator_remove(struct platform_device * pdev)551 static int __devexit da903x_regulator_remove(struct platform_device *pdev)
552 {
553 	struct regulator_dev *rdev = platform_get_drvdata(pdev);
554 
555 	regulator_unregister(rdev);
556 	return 0;
557 }
558 
559 static struct platform_driver da903x_regulator_driver = {
560 	.driver	= {
561 		.name	= "da903x-regulator",
562 		.owner	= THIS_MODULE,
563 	},
564 	.probe		= da903x_regulator_probe,
565 	.remove		= __devexit_p(da903x_regulator_remove),
566 };
567 
da903x_regulator_init(void)568 static int __init da903x_regulator_init(void)
569 {
570 	return platform_driver_register(&da903x_regulator_driver);
571 }
572 subsys_initcall(da903x_regulator_init);
573 
da903x_regulator_exit(void)574 static void __exit da903x_regulator_exit(void)
575 {
576 	platform_driver_unregister(&da903x_regulator_driver);
577 }
578 module_exit(da903x_regulator_exit);
579 
580 MODULE_LICENSE("GPL");
581 MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"
582 	      "Mike Rapoport <mike@compulab.co.il>");
583 MODULE_DESCRIPTION("Regulator Driver for Dialog Semiconductor DA903X PMIC");
584 MODULE_ALIAS("platform:da903x-regulator");
585