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/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
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
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
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
76struct 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
91static int da9034_ldo12_data[] = { 1700, 1750, 1800, 1850, 1900, 1950,
92 2000, 2050, 2700, 2750, 2800, 2850,
93 2900, 2950, 3000, 3050 };
94
95static inline struct device *to_da903x_dev(struct regulator_dev *rdev)
96{
97 return rdev_get_dev(rdev)->parent->parent;
98}
99
100static 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
110static 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
130static 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
147static 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
156static 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
165static 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, ®_val);
173 if (ret)
174 return ret;
175
176 return !!(reg_val & (1 << info->enable_bit));
177}
178
179static 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
191static 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;
210 mask |= DA9030_LDO_UNLOCK_MASK;
211
212
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
220static 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
249static 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
271static 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
298static 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
319static 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
339static 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
347static 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
357static 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
367static 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
376static 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
386static 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
455static struct da903x_regulator_info da903x_regulator_info[] = {
456
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),
478
479
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),
498
499
500 DA9035_DVC(BUCK3, 1800, 2200, 100, 3DTV1, 3, VCC2, 0, OVER3, 3),
501};
502
503static 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
516static 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
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
551static 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
559static 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
568static int __init da903x_regulator_init(void)
569{
570 return platform_driver_register(&da903x_regulator_driver);
571}
572subsys_initcall(da903x_regulator_init);
573
574static void __exit da903x_regulator_exit(void)
575{
576 platform_driver_unregister(&da903x_regulator_driver);
577}
578module_exit(da903x_regulator_exit);
579
580MODULE_LICENSE("GPL");
581MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"
582 "Mike Rapoport <mike@compulab.co.il>");
583MODULE_DESCRIPTION("Regulator Driver for Dialog Semiconductor DA903X PMIC");
584MODULE_ALIAS("platform:da903x-regulator");
585
