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 max_uV;
80 int vol_reg;
81 int vol_shift;
82 int vol_nbits;
83 int update_reg;
84 int update_bit;
85 int enable_reg;
86 int enable_bit;
87};
88
89static inline struct device *to_da903x_dev(struct regulator_dev *rdev)
90{
91 return rdev_get_dev(rdev)->parent->parent;
92}
93
94static inline int check_range(struct da903x_regulator_info *info,
95 int min_uV, int max_uV)
96{
97 if (min_uV < info->desc.min_uV || min_uV > info->max_uV)
98 return -EINVAL;
99
100 return 0;
101}
102
103
104static int da903x_set_voltage_sel(struct regulator_dev *rdev, unsigned selector)
105{
106 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
107 struct device *da9034_dev = to_da903x_dev(rdev);
108 uint8_t val, mask;
109
110 if (rdev->desc->n_voltages == 1)
111 return -EINVAL;
112
113 val = selector << info->vol_shift;
114 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
115
116 return da903x_update(da9034_dev, info->vol_reg, val, mask);
117}
118
119static int da903x_get_voltage_sel(struct regulator_dev *rdev)
120{
121 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
122 struct device *da9034_dev = to_da903x_dev(rdev);
123 uint8_t val, mask;
124 int ret;
125
126 if (rdev->desc->n_voltages == 1)
127 return 0;
128
129 ret = da903x_read(da9034_dev, info->vol_reg, &val);
130 if (ret)
131 return ret;
132
133 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
134 val = (val & mask) >> info->vol_shift;
135
136 return val;
137}
138
139static int da903x_enable(struct regulator_dev *rdev)
140{
141 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
142 struct device *da9034_dev = to_da903x_dev(rdev);
143
144 return da903x_set_bits(da9034_dev, info->enable_reg,
145 1 << info->enable_bit);
146}
147
148static int da903x_disable(struct regulator_dev *rdev)
149{
150 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
151 struct device *da9034_dev = to_da903x_dev(rdev);
152
153 return da903x_clr_bits(da9034_dev, info->enable_reg,
154 1 << info->enable_bit);
155}
156
157static int da903x_is_enabled(struct regulator_dev *rdev)
158{
159 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
160 struct device *da9034_dev = to_da903x_dev(rdev);
161 uint8_t reg_val;
162 int ret;
163
164 ret = da903x_read(da9034_dev, info->enable_reg, ®_val);
165 if (ret)
166 return ret;
167
168 return !!(reg_val & (1 << info->enable_bit));
169}
170
171
172static int da9030_set_ldo1_15_voltage_sel(struct regulator_dev *rdev,
173 unsigned selector)
174{
175 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
176 struct device *da903x_dev = to_da903x_dev(rdev);
177 uint8_t val, mask;
178 int ret;
179
180 val = selector << info->vol_shift;
181 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
182 val |= DA9030_LDO_UNLOCK;
183 mask |= DA9030_LDO_UNLOCK_MASK;
184
185
186 ret = da903x_update(da903x_dev, info->vol_reg, val, mask);
187 if (ret)
188 return ret;
189
190 return da903x_update(da903x_dev, info->vol_reg, val, mask);
191}
192
193static int da9030_map_ldo14_voltage(struct regulator_dev *rdev,
194 int min_uV, int max_uV)
195{
196 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
197 int thresh, sel;
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 thresh = (info->max_uV + info->desc.min_uV) / 2;
205 if (min_uV < thresh) {
206 sel = DIV_ROUND_UP(thresh - min_uV, info->desc.uV_step);
207 sel |= 0x4;
208 } else {
209 sel = DIV_ROUND_UP(min_uV - thresh, info->desc.uV_step);
210 }
211
212 return sel;
213}
214
215static int da9030_list_ldo14_voltage(struct regulator_dev *rdev,
216 unsigned selector)
217{
218 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
219 int volt;
220
221 if (selector & 0x4)
222 volt = rdev->desc->min_uV +
223 rdev->desc->uV_step * (3 - (selector & ~0x4));
224 else
225 volt = (info->max_uV + rdev->desc->min_uV) / 2 +
226 rdev->desc->uV_step * (selector & ~0x4);
227
228 if (volt > info->max_uV)
229 return -EINVAL;
230
231 return volt;
232}
233
234
235static int da9034_set_dvc_voltage_sel(struct regulator_dev *rdev,
236 unsigned selector)
237{
238 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
239 struct device *da9034_dev = to_da903x_dev(rdev);
240 uint8_t val, mask;
241 int ret;
242
243 val = selector << info->vol_shift;
244 mask = ((1 << info->vol_nbits) - 1) << info->vol_shift;
245
246 ret = da903x_update(da9034_dev, info->vol_reg, val, mask);
247 if (ret)
248 return ret;
249
250 ret = da903x_set_bits(da9034_dev, info->update_reg,
251 1 << info->update_bit);
252 return ret;
253}
254
255static int da9034_map_ldo12_voltage(struct regulator_dev *rdev,
256 int min_uV, int max_uV)
257{
258 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
259 int sel;
260
261 if (check_range(info, min_uV, max_uV)) {
262 pr_err("invalid voltage range (%d, %d) uV\n", min_uV, max_uV);
263 return -EINVAL;
264 }
265
266 sel = DIV_ROUND_UP(min_uV - info->desc.min_uV, info->desc.uV_step);
267 sel = (sel >= 20) ? sel - 12 : ((sel > 7) ? 8 : sel);
268
269 return sel;
270}
271
272static int da9034_list_ldo12_voltage(struct regulator_dev *rdev,
273 unsigned selector)
274{
275 struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
276 int volt;
277
278 if (selector >= 8)
279 volt = 2700000 + rdev->desc->uV_step * (selector - 8);
280 else
281 volt = rdev->desc->min_uV + rdev->desc->uV_step * selector;
282
283 if (volt > info->max_uV)
284 return -EINVAL;
285
286 return volt;
287}
288
289static struct regulator_ops da903x_regulator_ldo_ops = {
290 .set_voltage_sel = da903x_set_voltage_sel,
291 .get_voltage_sel = da903x_get_voltage_sel,
292 .list_voltage = regulator_list_voltage_linear,
293 .map_voltage = regulator_map_voltage_linear,
294 .enable = da903x_enable,
295 .disable = da903x_disable,
296 .is_enabled = da903x_is_enabled,
297};
298
299
300static struct regulator_ops da9030_regulator_ldo14_ops = {
301 .set_voltage_sel = da903x_set_voltage_sel,
302 .get_voltage_sel = da903x_get_voltage_sel,
303 .list_voltage = da9030_list_ldo14_voltage,
304 .map_voltage = da9030_map_ldo14_voltage,
305 .enable = da903x_enable,
306 .disable = da903x_disable,
307 .is_enabled = da903x_is_enabled,
308};
309
310
311static struct regulator_ops da9030_regulator_ldo1_15_ops = {
312 .set_voltage_sel = da9030_set_ldo1_15_voltage_sel,
313 .get_voltage_sel = da903x_get_voltage_sel,
314 .list_voltage = regulator_list_voltage_linear,
315 .map_voltage = regulator_map_voltage_linear,
316 .enable = da903x_enable,
317 .disable = da903x_disable,
318 .is_enabled = da903x_is_enabled,
319};
320
321static struct regulator_ops da9034_regulator_dvc_ops = {
322 .set_voltage_sel = da9034_set_dvc_voltage_sel,
323 .get_voltage_sel = da903x_get_voltage_sel,
324 .list_voltage = regulator_list_voltage_linear,
325 .map_voltage = regulator_map_voltage_linear,
326 .enable = da903x_enable,
327 .disable = da903x_disable,
328 .is_enabled = da903x_is_enabled,
329};
330
331
332static struct regulator_ops da9034_regulator_ldo12_ops = {
333 .set_voltage_sel = da903x_set_voltage_sel,
334 .get_voltage_sel = da903x_get_voltage_sel,
335 .list_voltage = da9034_list_ldo12_voltage,
336 .map_voltage = da9034_map_ldo12_voltage,
337 .enable = da903x_enable,
338 .disable = da903x_disable,
339 .is_enabled = da903x_is_enabled,
340};
341
342#define DA903x_LDO(_pmic, _id, min, max, step, vreg, shift, nbits, ereg, ebit) \
343{ \
344 .desc = { \
345 .name = "LDO" #_id, \
346 .ops = &da903x_regulator_ldo_ops, \
347 .type = REGULATOR_VOLTAGE, \
348 .id = _pmic##_ID_LDO##_id, \
349 .n_voltages = (step) ? ((max - min) / step + 1) : 1, \
350 .owner = THIS_MODULE, \
351 .min_uV = (min) * 1000, \
352 .uV_step = (step) * 1000, \
353 }, \
354 .max_uV = (max) * 1000, \
355 .vol_reg = _pmic##_##vreg, \
356 .vol_shift = (shift), \
357 .vol_nbits = (nbits), \
358 .enable_reg = _pmic##_##ereg, \
359 .enable_bit = (ebit), \
360}
361
362#define DA903x_DVC(_pmic, _id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
363{ \
364 .desc = { \
365 .name = #_id, \
366 .ops = &da9034_regulator_dvc_ops, \
367 .type = REGULATOR_VOLTAGE, \
368 .id = _pmic##_ID_##_id, \
369 .n_voltages = (step) ? ((max - min) / step + 1) : 1, \
370 .owner = THIS_MODULE, \
371 .min_uV = (min) * 1000, \
372 .uV_step = (step) * 1000, \
373 }, \
374 .max_uV = (max) * 1000, \
375 .vol_reg = _pmic##_##vreg, \
376 .vol_shift = (0), \
377 .vol_nbits = (nbits), \
378 .update_reg = _pmic##_##ureg, \
379 .update_bit = (ubit), \
380 .enable_reg = _pmic##_##ereg, \
381 .enable_bit = (ebit), \
382}
383
384#define DA9034_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
385 DA903x_LDO(DA9034, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
386
387#define DA9030_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
388 DA903x_LDO(DA9030, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
389
390#define DA9030_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
391 DA903x_DVC(DA9030, _id, min, max, step, vreg, nbits, ureg, ubit, \
392 ereg, ebit)
393
394#define DA9034_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
395 DA903x_DVC(DA9034, _id, min, max, step, vreg, nbits, ureg, ubit, \
396 ereg, ebit)
397
398#define DA9035_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
399 DA903x_DVC(DA9035, _id, min, max, step, vreg, nbits, ureg, ubit, \
400 ereg, ebit)
401
402static struct da903x_regulator_info da903x_regulator_info[] = {
403
404 DA9030_DVC(BUCK2, 850, 1625, 25, BUCK2DVM1, 5, BUCK2DVM1, 7, RCTL11, 0),
405
406 DA9030_LDO( 1, 1200, 3200, 100, LDO1, 0, 5, RCTL12, 1),
407 DA9030_LDO( 2, 1800, 3200, 100, LDO23, 0, 4, RCTL12, 2),
408 DA9030_LDO( 3, 1800, 3200, 100, LDO23, 4, 4, RCTL12, 3),
409 DA9030_LDO( 4, 1800, 3200, 100, LDO45, 0, 4, RCTL12, 4),
410 DA9030_LDO( 5, 1800, 3200, 100, LDO45, 4, 4, RCTL12, 5),
411 DA9030_LDO( 6, 1800, 3200, 100, LDO6, 0, 4, RCTL12, 6),
412 DA9030_LDO( 7, 1800, 3200, 100, LDO78, 0, 4, RCTL12, 7),
413 DA9030_LDO( 8, 1800, 3200, 100, LDO78, 4, 4, RCTL22, 0),
414 DA9030_LDO( 9, 1800, 3200, 100, LDO912, 0, 4, RCTL22, 1),
415 DA9030_LDO(10, 1800, 3200, 100, LDO1011, 0, 4, RCTL22, 2),
416 DA9030_LDO(11, 1800, 3200, 100, LDO1011, 4, 4, RCTL22, 3),
417 DA9030_LDO(12, 1800, 3200, 100, LDO912, 4, 4, RCTL22, 4),
418 DA9030_LDO(14, 2760, 2940, 30, LDO1416, 0, 3, RCTL11, 4),
419 DA9030_LDO(15, 1100, 2650, 50, LDO15, 0, 5, RCTL11, 5),
420 DA9030_LDO(16, 1100, 2650, 50, LDO1416, 3, 5, RCTL11, 6),
421 DA9030_LDO(17, 1800, 3200, 100, LDO17, 0, 4, RCTL11, 7),
422 DA9030_LDO(18, 1800, 3200, 100, LDO1819, 0, 4, RCTL21, 2),
423 DA9030_LDO(19, 1800, 3200, 100, LDO1819, 4, 4, RCTL21, 1),
424 DA9030_LDO(13, 2100, 2100, 0, INVAL, 0, 0, RCTL11, 3),
425
426
427 DA9034_DVC(BUCK1, 725, 1500, 25, ADTV2, 5, VCC1, 0, OVER1, 0),
428 DA9034_DVC(BUCK2, 725, 1500, 25, CDTV2, 5, VCC1, 2, OVER1, 1),
429 DA9034_DVC(LDO2, 725, 1500, 25, SDTV2, 5, VCC1, 4, OVER1, 2),
430 DA9034_DVC(LDO1, 1700, 2075, 25, MDTV1, 4, VCC1, 6, OVER3, 4),
431
432 DA9034_LDO( 3, 1800, 3300, 100, LDO643, 0, 4, OVER3, 5),
433 DA9034_LDO( 4, 1800, 2900,1100, LDO643, 4, 1, OVER3, 6),
434 DA9034_LDO( 6, 2500, 2850, 50, LDO643, 5, 3, OVER2, 0),
435 DA9034_LDO( 7, 2700, 3050, 50, LDO987, 0, 3, OVER2, 1),
436 DA9034_LDO( 8, 2700, 2850, 50, LDO987, 3, 2, OVER2, 2),
437 DA9034_LDO( 9, 2700, 3050, 50, LDO987, 5, 3, OVER2, 3),
438 DA9034_LDO(10, 2700, 3050, 50, LDO1110, 0, 3, OVER2, 4),
439 DA9034_LDO(11, 1800, 3300, 100, LDO1110, 4, 4, OVER2, 5),
440 DA9034_LDO(12, 1700, 3050, 50, LDO1312, 0, 4, OVER3, 6),
441 DA9034_LDO(13, 1800, 3300, 100, LDO1312, 4, 4, OVER2, 7),
442 DA9034_LDO(14, 1800, 3300, 100, LDO1514, 0, 4, OVER3, 0),
443 DA9034_LDO(15, 1800, 3300, 100, LDO1514, 4, 4, OVER3, 1),
444 DA9034_LDO(5, 3100, 3100, 0, INVAL, 0, 0, OVER3, 7),
445
446
447 DA9035_DVC(BUCK3, 1800, 2200, 100, 3DTV1, 3, VCC2, 0, OVER3, 3),
448};
449
450static inline struct da903x_regulator_info *find_regulator_info(int id)
451{
452 struct da903x_regulator_info *ri;
453 int i;
454
455 for (i = 0; i < ARRAY_SIZE(da903x_regulator_info); i++) {
456 ri = &da903x_regulator_info[i];
457 if (ri->desc.id == id)
458 return ri;
459 }
460 return NULL;
461}
462
463static int da903x_regulator_probe(struct platform_device *pdev)
464{
465 struct da903x_regulator_info *ri = NULL;
466 struct regulator_dev *rdev;
467 struct regulator_config config = { };
468
469 ri = find_regulator_info(pdev->id);
470 if (ri == NULL) {
471 dev_err(&pdev->dev, "invalid regulator ID specified\n");
472 return -EINVAL;
473 }
474
475
476 if (ri->desc.id == DA9034_ID_LDO12) {
477 ri->desc.ops = &da9034_regulator_ldo12_ops;
478 ri->desc.n_voltages = 16;
479 }
480
481 if (ri->desc.id == DA9030_ID_LDO14)
482 ri->desc.ops = &da9030_regulator_ldo14_ops;
483
484 if (ri->desc.id == DA9030_ID_LDO1 || ri->desc.id == DA9030_ID_LDO15)
485 ri->desc.ops = &da9030_regulator_ldo1_15_ops;
486
487 config.dev = &pdev->dev;
488 config.init_data = pdev->dev.platform_data;
489 config.driver_data = ri;
490
491 rdev = regulator_register(&ri->desc, &config);
492 if (IS_ERR(rdev)) {
493 dev_err(&pdev->dev, "failed to register regulator %s\n",
494 ri->desc.name);
495 return PTR_ERR(rdev);
496 }
497
498 platform_set_drvdata(pdev, rdev);
499 return 0;
500}
501
502static int da903x_regulator_remove(struct platform_device *pdev)
503{
504 struct regulator_dev *rdev = platform_get_drvdata(pdev);
505
506 regulator_unregister(rdev);
507 return 0;
508}
509
510static struct platform_driver da903x_regulator_driver = {
511 .driver = {
512 .name = "da903x-regulator",
513 .owner = THIS_MODULE,
514 },
515 .probe = da903x_regulator_probe,
516 .remove = da903x_regulator_remove,
517};
518
519static int __init da903x_regulator_init(void)
520{
521 return platform_driver_register(&da903x_regulator_driver);
522}
523subsys_initcall(da903x_regulator_init);
524
525static void __exit da903x_regulator_exit(void)
526{
527 platform_driver_unregister(&da903x_regulator_driver);
528}
529module_exit(da903x_regulator_exit);
530
531MODULE_LICENSE("GPL");
532MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"
533 "Mike Rapoport <mike@compulab.co.il>");
534MODULE_DESCRIPTION("Regulator Driver for Dialog Semiconductor DA903X PMIC");
535MODULE_ALIAS("platform:da903x-regulator");
536
