1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/kernel.h>
19#include <linux/module.h>
20#include <linux/init.h>
21#include <linux/err.h>
22#include <linux/platform_device.h>
23#include <linux/regulator/driver.h>
24#include <linux/regulator/machine.h>
25#include <linux/regulator/tps6507x.h>
26#include <linux/delay.h>
27#include <linux/slab.h>
28#include <linux/mfd/tps6507x.h>
29
30
31#define TPS6507X_DCDC_1 0
32#define TPS6507X_DCDC_2 1
33#define TPS6507X_DCDC_3 2
34
35#define TPS6507X_LDO_1 3
36#define TPS6507X_LDO_2 4
37
38#define TPS6507X_MAX_REG_ID TPS6507X_LDO_2
39
40
41#define TPS6507X_NUM_DCDC 3
42
43#define TPS6507X_NUM_LDO 2
44
45#define TPS6507X_NUM_REGULATOR (TPS6507X_NUM_DCDC + TPS6507X_NUM_LDO)
46
47
48static const u16 VDCDCx_VSEL_table[] = {
49 725, 750, 775, 800,
50 825, 850, 875, 900,
51 925, 950, 975, 1000,
52 1025, 1050, 1075, 1100,
53 1125, 1150, 1175, 1200,
54 1225, 1250, 1275, 1300,
55 1325, 1350, 1375, 1400,
56 1425, 1450, 1475, 1500,
57 1550, 1600, 1650, 1700,
58 1750, 1800, 1850, 1900,
59 1950, 2000, 2050, 2100,
60 2150, 2200, 2250, 2300,
61 2350, 2400, 2450, 2500,
62 2550, 2600, 2650, 2700,
63 2750, 2800, 2850, 2900,
64 3000, 3100, 3200, 3300,
65};
66
67static const u16 LDO1_VSEL_table[] = {
68 1000, 1100, 1200, 1250,
69 1300, 1350, 1400, 1500,
70 1600, 1800, 2500, 2750,
71 2800, 3000, 3100, 3300,
72};
73
74static const u16 LDO2_VSEL_table[] = {
75 725, 750, 775, 800,
76 825, 850, 875, 900,
77 925, 950, 975, 1000,
78 1025, 1050, 1075, 1100,
79 1125, 1150, 1175, 1200,
80 1225, 1250, 1275, 1300,
81 1325, 1350, 1375, 1400,
82 1425, 1450, 1475, 1500,
83 1550, 1600, 1650, 1700,
84 1750, 1800, 1850, 1900,
85 1950, 2000, 2050, 2100,
86 2150, 2200, 2250, 2300,
87 2350, 2400, 2450, 2500,
88 2550, 2600, 2650, 2700,
89 2750, 2800, 2850, 2900,
90 3000, 3100, 3200, 3300,
91};
92
93static unsigned int num_voltages[] = {ARRAY_SIZE(VDCDCx_VSEL_table),
94 ARRAY_SIZE(VDCDCx_VSEL_table),
95 ARRAY_SIZE(VDCDCx_VSEL_table),
96 ARRAY_SIZE(LDO1_VSEL_table),
97 ARRAY_SIZE(LDO2_VSEL_table)};
98
99struct tps_info {
100 const char *name;
101 unsigned min_uV;
102 unsigned max_uV;
103 u8 table_len;
104 const u16 *table;
105
106
107 bool defdcdc_default;
108};
109
110static struct tps_info tps6507x_pmic_regs[] = {
111 {
112 .name = "VDCDC1",
113 .min_uV = 725000,
114 .max_uV = 3300000,
115 .table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
116 .table = VDCDCx_VSEL_table,
117 },
118 {
119 .name = "VDCDC2",
120 .min_uV = 725000,
121 .max_uV = 3300000,
122 .table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
123 .table = VDCDCx_VSEL_table,
124 },
125 {
126 .name = "VDCDC3",
127 .min_uV = 725000,
128 .max_uV = 3300000,
129 .table_len = ARRAY_SIZE(VDCDCx_VSEL_table),
130 .table = VDCDCx_VSEL_table,
131 },
132 {
133 .name = "LDO1",
134 .min_uV = 1000000,
135 .max_uV = 3300000,
136 .table_len = ARRAY_SIZE(LDO1_VSEL_table),
137 .table = LDO1_VSEL_table,
138 },
139 {
140 .name = "LDO2",
141 .min_uV = 725000,
142 .max_uV = 3300000,
143 .table_len = ARRAY_SIZE(LDO2_VSEL_table),
144 .table = LDO2_VSEL_table,
145 },
146};
147
148struct tps6507x_pmic {
149 struct regulator_desc desc[TPS6507X_NUM_REGULATOR];
150 struct tps6507x_dev *mfd;
151 struct regulator_dev *rdev[TPS6507X_NUM_REGULATOR];
152 struct tps_info *info[TPS6507X_NUM_REGULATOR];
153 struct mutex io_lock;
154};
155static inline int tps6507x_pmic_read(struct tps6507x_pmic *tps, u8 reg)
156{
157 u8 val;
158 int err;
159
160 err = tps->mfd->read_dev(tps->mfd, reg, 1, &val);
161
162 if (err)
163 return err;
164
165 return val;
166}
167
168static inline int tps6507x_pmic_write(struct tps6507x_pmic *tps, u8 reg, u8 val)
169{
170 return tps->mfd->write_dev(tps->mfd, reg, 1, &val);
171}
172
173static int tps6507x_pmic_set_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask)
174{
175 int err, data;
176
177 mutex_lock(&tps->io_lock);
178
179 data = tps6507x_pmic_read(tps, reg);
180 if (data < 0) {
181 dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);
182 err = data;
183 goto out;
184 }
185
186 data |= mask;
187 err = tps6507x_pmic_write(tps, reg, data);
188 if (err)
189 dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);
190
191out:
192 mutex_unlock(&tps->io_lock);
193 return err;
194}
195
196static int tps6507x_pmic_clear_bits(struct tps6507x_pmic *tps, u8 reg, u8 mask)
197{
198 int err, data;
199
200 mutex_lock(&tps->io_lock);
201
202 data = tps6507x_pmic_read(tps, reg);
203 if (data < 0) {
204 dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);
205 err = data;
206 goto out;
207 }
208
209 data &= ~mask;
210 err = tps6507x_pmic_write(tps, reg, data);
211 if (err)
212 dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);
213
214out:
215 mutex_unlock(&tps->io_lock);
216 return err;
217}
218
219static int tps6507x_pmic_reg_read(struct tps6507x_pmic *tps, u8 reg)
220{
221 int data;
222
223 mutex_lock(&tps->io_lock);
224
225 data = tps6507x_pmic_read(tps, reg);
226 if (data < 0)
227 dev_err(tps->mfd->dev, "Read from reg 0x%x failed\n", reg);
228
229 mutex_unlock(&tps->io_lock);
230 return data;
231}
232
233static int tps6507x_pmic_reg_write(struct tps6507x_pmic *tps, u8 reg, u8 val)
234{
235 int err;
236
237 mutex_lock(&tps->io_lock);
238
239 err = tps6507x_pmic_write(tps, reg, val);
240 if (err < 0)
241 dev_err(tps->mfd->dev, "Write for reg 0x%x failed\n", reg);
242
243 mutex_unlock(&tps->io_lock);
244 return err;
245}
246
247static int tps6507x_pmic_dcdc_is_enabled(struct regulator_dev *dev)
248{
249 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
250 int data, dcdc = rdev_get_id(dev);
251 u8 shift;
252
253 if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3)
254 return -EINVAL;
255
256 shift = TPS6507X_MAX_REG_ID - dcdc;
257 data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1);
258
259 if (data < 0)
260 return data;
261 else
262 return (data & 1<<shift) ? 1 : 0;
263}
264
265static int tps6507x_pmic_ldo_is_enabled(struct regulator_dev *dev)
266{
267 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
268 int data, ldo = rdev_get_id(dev);
269 u8 shift;
270
271 if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2)
272 return -EINVAL;
273
274 shift = TPS6507X_MAX_REG_ID - ldo;
275 data = tps6507x_pmic_reg_read(tps, TPS6507X_REG_CON_CTRL1);
276
277 if (data < 0)
278 return data;
279 else
280 return (data & 1<<shift) ? 1 : 0;
281}
282
283static int tps6507x_pmic_dcdc_enable(struct regulator_dev *dev)
284{
285 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
286 int dcdc = rdev_get_id(dev);
287 u8 shift;
288
289 if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3)
290 return -EINVAL;
291
292 shift = TPS6507X_MAX_REG_ID - dcdc;
293 return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift);
294}
295
296static int tps6507x_pmic_dcdc_disable(struct regulator_dev *dev)
297{
298 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
299 int dcdc = rdev_get_id(dev);
300 u8 shift;
301
302 if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3)
303 return -EINVAL;
304
305 shift = TPS6507X_MAX_REG_ID - dcdc;
306 return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1,
307 1 << shift);
308}
309
310static int tps6507x_pmic_ldo_enable(struct regulator_dev *dev)
311{
312 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
313 int ldo = rdev_get_id(dev);
314 u8 shift;
315
316 if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2)
317 return -EINVAL;
318
319 shift = TPS6507X_MAX_REG_ID - ldo;
320 return tps6507x_pmic_set_bits(tps, TPS6507X_REG_CON_CTRL1, 1 << shift);
321}
322
323static int tps6507x_pmic_ldo_disable(struct regulator_dev *dev)
324{
325 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
326 int ldo = rdev_get_id(dev);
327 u8 shift;
328
329 if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2)
330 return -EINVAL;
331
332 shift = TPS6507X_MAX_REG_ID - ldo;
333 return tps6507x_pmic_clear_bits(tps, TPS6507X_REG_CON_CTRL1,
334 1 << shift);
335}
336
337static int tps6507x_pmic_dcdc_get_voltage(struct regulator_dev *dev)
338{
339 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
340 int data, dcdc = rdev_get_id(dev);
341 u8 reg;
342
343 switch (dcdc) {
344 case TPS6507X_DCDC_1:
345 reg = TPS6507X_REG_DEFDCDC1;
346 break;
347 case TPS6507X_DCDC_2:
348 if (tps->info[dcdc]->defdcdc_default)
349 reg = TPS6507X_REG_DEFDCDC2_HIGH;
350 else
351 reg = TPS6507X_REG_DEFDCDC2_LOW;
352 break;
353 case TPS6507X_DCDC_3:
354 if (tps->info[dcdc]->defdcdc_default)
355 reg = TPS6507X_REG_DEFDCDC3_HIGH;
356 else
357 reg = TPS6507X_REG_DEFDCDC3_LOW;
358 break;
359 default:
360 return -EINVAL;
361 }
362
363 data = tps6507x_pmic_reg_read(tps, reg);
364 if (data < 0)
365 return data;
366
367 data &= TPS6507X_DEFDCDCX_DCDC_MASK;
368 return tps->info[dcdc]->table[data] * 1000;
369}
370
371static int tps6507x_pmic_dcdc_set_voltage(struct regulator_dev *dev,
372 int min_uV, int max_uV,
373 unsigned *selector)
374{
375 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
376 int data, vsel, dcdc = rdev_get_id(dev);
377 u8 reg;
378
379 switch (dcdc) {
380 case TPS6507X_DCDC_1:
381 reg = TPS6507X_REG_DEFDCDC1;
382 break;
383 case TPS6507X_DCDC_2:
384 if (tps->info[dcdc]->defdcdc_default)
385 reg = TPS6507X_REG_DEFDCDC2_HIGH;
386 else
387 reg = TPS6507X_REG_DEFDCDC2_LOW;
388 break;
389 case TPS6507X_DCDC_3:
390 if (tps->info[dcdc]->defdcdc_default)
391 reg = TPS6507X_REG_DEFDCDC3_HIGH;
392 else
393 reg = TPS6507X_REG_DEFDCDC3_LOW;
394 break;
395 default:
396 return -EINVAL;
397 }
398
399 if (min_uV < tps->info[dcdc]->min_uV
400 || min_uV > tps->info[dcdc]->max_uV)
401 return -EINVAL;
402 if (max_uV < tps->info[dcdc]->min_uV
403 || max_uV > tps->info[dcdc]->max_uV)
404 return -EINVAL;
405
406 for (vsel = 0; vsel < tps->info[dcdc]->table_len; vsel++) {
407 int mV = tps->info[dcdc]->table[vsel];
408 int uV = mV * 1000;
409
410
411 if (min_uV <= uV && uV <= max_uV)
412 break;
413 }
414
415
416 if (vsel == tps->info[dcdc]->table_len)
417 return -EINVAL;
418
419 *selector = vsel;
420
421 data = tps6507x_pmic_reg_read(tps, reg);
422 if (data < 0)
423 return data;
424
425 data &= ~TPS6507X_DEFDCDCX_DCDC_MASK;
426 data |= vsel;
427
428 return tps6507x_pmic_reg_write(tps, reg, data);
429}
430
431static int tps6507x_pmic_ldo_get_voltage(struct regulator_dev *dev)
432{
433 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
434 int data, ldo = rdev_get_id(dev);
435 u8 reg, mask;
436
437 if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2)
438 return -EINVAL;
439 else {
440 reg = (ldo == TPS6507X_LDO_1 ?
441 TPS6507X_REG_LDO_CTRL1 : TPS6507X_REG_DEFLDO2);
442 mask = (ldo == TPS6507X_LDO_1 ?
443 TPS6507X_REG_LDO_CTRL1_LDO1_MASK :
444 TPS6507X_REG_DEFLDO2_LDO2_MASK);
445 }
446
447 data = tps6507x_pmic_reg_read(tps, reg);
448 if (data < 0)
449 return data;
450
451 data &= mask;
452 return tps->info[ldo]->table[data] * 1000;
453}
454
455static int tps6507x_pmic_ldo_set_voltage(struct regulator_dev *dev,
456 int min_uV, int max_uV,
457 unsigned *selector)
458{
459 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
460 int data, vsel, ldo = rdev_get_id(dev);
461 u8 reg, mask;
462
463 if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2)
464 return -EINVAL;
465 else {
466 reg = (ldo == TPS6507X_LDO_1 ?
467 TPS6507X_REG_LDO_CTRL1 : TPS6507X_REG_DEFLDO2);
468 mask = (ldo == TPS6507X_LDO_1 ?
469 TPS6507X_REG_LDO_CTRL1_LDO1_MASK :
470 TPS6507X_REG_DEFLDO2_LDO2_MASK);
471 }
472
473 if (min_uV < tps->info[ldo]->min_uV || min_uV > tps->info[ldo]->max_uV)
474 return -EINVAL;
475 if (max_uV < tps->info[ldo]->min_uV || max_uV > tps->info[ldo]->max_uV)
476 return -EINVAL;
477
478 for (vsel = 0; vsel < tps->info[ldo]->table_len; vsel++) {
479 int mV = tps->info[ldo]->table[vsel];
480 int uV = mV * 1000;
481
482
483 if (min_uV <= uV && uV <= max_uV)
484 break;
485 }
486
487 if (vsel == tps->info[ldo]->table_len)
488 return -EINVAL;
489
490 *selector = vsel;
491
492 data = tps6507x_pmic_reg_read(tps, reg);
493 if (data < 0)
494 return data;
495
496 data &= ~mask;
497 data |= vsel;
498
499 return tps6507x_pmic_reg_write(tps, reg, data);
500}
501
502static int tps6507x_pmic_dcdc_list_voltage(struct regulator_dev *dev,
503 unsigned selector)
504{
505 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
506 int dcdc = rdev_get_id(dev);
507
508 if (dcdc < TPS6507X_DCDC_1 || dcdc > TPS6507X_DCDC_3)
509 return -EINVAL;
510
511 if (selector >= tps->info[dcdc]->table_len)
512 return -EINVAL;
513 else
514 return tps->info[dcdc]->table[selector] * 1000;
515}
516
517static int tps6507x_pmic_ldo_list_voltage(struct regulator_dev *dev,
518 unsigned selector)
519{
520 struct tps6507x_pmic *tps = rdev_get_drvdata(dev);
521 int ldo = rdev_get_id(dev);
522
523 if (ldo < TPS6507X_LDO_1 || ldo > TPS6507X_LDO_2)
524 return -EINVAL;
525
526 if (selector >= tps->info[ldo]->table_len)
527 return -EINVAL;
528 else
529 return tps->info[ldo]->table[selector] * 1000;
530}
531
532
533static struct regulator_ops tps6507x_pmic_dcdc_ops = {
534 .is_enabled = tps6507x_pmic_dcdc_is_enabled,
535 .enable = tps6507x_pmic_dcdc_enable,
536 .disable = tps6507x_pmic_dcdc_disable,
537 .get_voltage = tps6507x_pmic_dcdc_get_voltage,
538 .set_voltage = tps6507x_pmic_dcdc_set_voltage,
539 .list_voltage = tps6507x_pmic_dcdc_list_voltage,
540};
541
542
543static struct regulator_ops tps6507x_pmic_ldo_ops = {
544 .is_enabled = tps6507x_pmic_ldo_is_enabled,
545 .enable = tps6507x_pmic_ldo_enable,
546 .disable = tps6507x_pmic_ldo_disable,
547 .get_voltage = tps6507x_pmic_ldo_get_voltage,
548 .set_voltage = tps6507x_pmic_ldo_set_voltage,
549 .list_voltage = tps6507x_pmic_ldo_list_voltage,
550};
551
552static __devinit
553int tps6507x_pmic_probe(struct platform_device *pdev)
554{
555 struct tps6507x_dev *tps6507x_dev = dev_get_drvdata(pdev->dev.parent);
556 struct tps_info *info = &tps6507x_pmic_regs[0];
557 struct regulator_init_data *init_data;
558 struct regulator_dev *rdev;
559 struct tps6507x_pmic *tps;
560 struct tps6507x_board *tps_board;
561 int i;
562 int error;
563
564
565
566
567
568
569 tps_board = dev_get_platdata(tps6507x_dev->dev);
570 if (!tps_board)
571 return -EINVAL;
572
573
574
575
576
577 init_data = tps_board->tps6507x_pmic_init_data;
578 if (!init_data)
579 return -EINVAL;
580
581 tps = kzalloc(sizeof(*tps), GFP_KERNEL);
582 if (!tps)
583 return -ENOMEM;
584
585 mutex_init(&tps->io_lock);
586
587
588 tps->mfd = tps6507x_dev;
589
590 for (i = 0; i < TPS6507X_NUM_REGULATOR; i++, info++, init_data++) {
591
592 tps->info[i] = info;
593 if (init_data->driver_data) {
594 struct tps6507x_reg_platform_data *data =
595 init_data->driver_data;
596 tps->info[i]->defdcdc_default = data->defdcdc_default;
597 }
598
599 tps->desc[i].name = info->name;
600 tps->desc[i].id = i;
601 tps->desc[i].n_voltages = num_voltages[i];
602 tps->desc[i].ops = (i > TPS6507X_DCDC_3 ?
603 &tps6507x_pmic_ldo_ops : &tps6507x_pmic_dcdc_ops);
604 tps->desc[i].type = REGULATOR_VOLTAGE;
605 tps->desc[i].owner = THIS_MODULE;
606
607 rdev = regulator_register(&tps->desc[i],
608 tps6507x_dev->dev, init_data, tps);
609 if (IS_ERR(rdev)) {
610 dev_err(tps6507x_dev->dev,
611 "failed to register %s regulator\n",
612 pdev->name);
613 error = PTR_ERR(rdev);
614 goto fail;
615 }
616
617
618 tps->rdev[i] = rdev;
619 }
620
621 tps6507x_dev->pmic = tps;
622 platform_set_drvdata(pdev, tps6507x_dev);
623
624 return 0;
625
626fail:
627 while (--i >= 0)
628 regulator_unregister(tps->rdev[i]);
629
630 kfree(tps);
631 return error;
632}
633
634static int __devexit tps6507x_pmic_remove(struct platform_device *pdev)
635{
636 struct tps6507x_dev *tps6507x_dev = platform_get_drvdata(pdev);
637 struct tps6507x_pmic *tps = tps6507x_dev->pmic;
638 int i;
639
640 for (i = 0; i < TPS6507X_NUM_REGULATOR; i++)
641 regulator_unregister(tps->rdev[i]);
642
643 kfree(tps);
644
645 return 0;
646}
647
648static struct platform_driver tps6507x_pmic_driver = {
649 .driver = {
650 .name = "tps6507x-pmic",
651 .owner = THIS_MODULE,
652 },
653 .probe = tps6507x_pmic_probe,
654 .remove = __devexit_p(tps6507x_pmic_remove),
655};
656
657
658
659
660
661
662static int __init tps6507x_pmic_init(void)
663{
664 return platform_driver_register(&tps6507x_pmic_driver);
665}
666subsys_initcall(tps6507x_pmic_init);
667
668
669
670
671
672
673static void __exit tps6507x_pmic_cleanup(void)
674{
675 platform_driver_unregister(&tps6507x_pmic_driver);
676}
677module_exit(tps6507x_pmic_cleanup);
678
679MODULE_AUTHOR("Texas Instruments");
680MODULE_DESCRIPTION("TPS6507x voltage regulator driver");
681MODULE_LICENSE("GPL v2");
682MODULE_ALIAS("platform:tps6507x-pmic");
683
