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