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/i2c.h>
26#include <linux/delay.h>
27#include <linux/slab.h>
28
29
30#define TPS65023_REG_VERSION 0
31#define TPS65023_REG_PGOODZ 1
32#define TPS65023_REG_MASK 2
33#define TPS65023_REG_REG_CTRL 3
34#define TPS65023_REG_CON_CTRL 4
35#define TPS65023_REG_CON_CTRL2 5
36#define TPS65023_REG_DEF_CORE 6
37#define TPS65023_REG_DEFSLEW 7
38#define TPS65023_REG_LDO_CTRL 8
39
40
41#define TPS65023_PGOODZ_PWRFAILZ BIT(7)
42#define TPS65023_PGOODZ_LOWBATTZ BIT(6)
43#define TPS65023_PGOODZ_VDCDC1 BIT(5)
44#define TPS65023_PGOODZ_VDCDC2 BIT(4)
45#define TPS65023_PGOODZ_VDCDC3 BIT(3)
46#define TPS65023_PGOODZ_LDO2 BIT(2)
47#define TPS65023_PGOODZ_LDO1 BIT(1)
48
49
50#define TPS65023_MASK_PWRFAILZ BIT(7)
51#define TPS65023_MASK_LOWBATTZ BIT(6)
52#define TPS65023_MASK_VDCDC1 BIT(5)
53#define TPS65023_MASK_VDCDC2 BIT(4)
54#define TPS65023_MASK_VDCDC3 BIT(3)
55#define TPS65023_MASK_LDO2 BIT(2)
56#define TPS65023_MASK_LDO1 BIT(1)
57
58
59#define TPS65023_REG_CTRL_VDCDC1_EN BIT(5)
60#define TPS65023_REG_CTRL_VDCDC2_EN BIT(4)
61#define TPS65023_REG_CTRL_VDCDC3_EN BIT(3)
62#define TPS65023_REG_CTRL_LDO2_EN BIT(2)
63#define TPS65023_REG_CTRL_LDO1_EN BIT(1)
64
65
66#define TPS65023_LDO_CTRL_LDOx_SHIFT(ldo_id) ((ldo_id)*4)
67#define TPS65023_LDO_CTRL_LDOx_MASK(ldo_id) (0xF0 >> ((ldo_id)*4))
68
69
70#define TPS65023_NUM_DCDC 3
71
72#define TPS65023_NUM_LDO 2
73
74#define TPS65023_NUM_REGULATOR (TPS65023_NUM_DCDC + TPS65023_NUM_LDO)
75
76
77#define TPS65023_DCDC_1 0
78#define TPS65023_DCDC_2 1
79#define TPS65023_DCDC_3 2
80
81#define TPS65023_LDO_1 3
82#define TPS65023_LDO_2 4
83
84#define TPS65023_MAX_REG_ID TPS65023_LDO_2
85
86
87static const u16 VDCDC1_VSEL_table[] = {
88 800, 825, 850, 875,
89 900, 925, 950, 975,
90 1000, 1025, 1050, 1075,
91 1100, 1125, 1150, 1175,
92 1200, 1225, 1250, 1275,
93 1300, 1325, 1350, 1375,
94 1400, 1425, 1450, 1475,
95 1500, 1525, 1550, 1600,
96};
97
98static const u16 LDO1_VSEL_table[] = {
99 1000, 1100, 1300, 1800,
100 2200, 2600, 2800, 3150,
101};
102
103static const u16 LDO2_VSEL_table[] = {
104 1050, 1200, 1300, 1800,
105 2500, 2800, 3000, 3300,
106};
107
108static unsigned int num_voltages[] = {ARRAY_SIZE(VDCDC1_VSEL_table),
109 0, 0, ARRAY_SIZE(LDO1_VSEL_table),
110 ARRAY_SIZE(LDO2_VSEL_table)};
111
112
113struct tps_info {
114 const char *name;
115 unsigned min_uV;
116 unsigned max_uV;
117 bool fixed;
118 u8 table_len;
119 const u16 *table;
120};
121
122
123struct tps_pmic {
124 struct regulator_desc desc[TPS65023_NUM_REGULATOR];
125 struct i2c_client *client;
126 struct regulator_dev *rdev[TPS65023_NUM_REGULATOR];
127 const struct tps_info *info[TPS65023_NUM_REGULATOR];
128 struct mutex io_lock;
129};
130
131static inline int tps_65023_read(struct tps_pmic *tps, u8 reg)
132{
133 return i2c_smbus_read_byte_data(tps->client, reg);
134}
135
136static inline int tps_65023_write(struct tps_pmic *tps, u8 reg, u8 val)
137{
138 return i2c_smbus_write_byte_data(tps->client, reg, val);
139}
140
141static int tps_65023_set_bits(struct tps_pmic *tps, u8 reg, u8 mask)
142{
143 int err, data;
144
145 mutex_lock(&tps->io_lock);
146
147 data = tps_65023_read(tps, reg);
148 if (data < 0) {
149 dev_err(&tps->client->dev, "Read from reg 0x%x failed\n", reg);
150 err = data;
151 goto out;
152 }
153
154 data |= mask;
155 err = tps_65023_write(tps, reg, data);
156 if (err)
157 dev_err(&tps->client->dev, "Write for reg 0x%x failed\n", reg);
158
159out:
160 mutex_unlock(&tps->io_lock);
161 return err;
162}
163
164static int tps_65023_clear_bits(struct tps_pmic *tps, u8 reg, u8 mask)
165{
166 int err, data;
167
168 mutex_lock(&tps->io_lock);
169
170 data = tps_65023_read(tps, reg);
171 if (data < 0) {
172 dev_err(&tps->client->dev, "Read from reg 0x%x failed\n", reg);
173 err = data;
174 goto out;
175 }
176
177 data &= ~mask;
178
179 err = tps_65023_write(tps, reg, data);
180 if (err)
181 dev_err(&tps->client->dev, "Write for reg 0x%x failed\n", reg);
182
183out:
184 mutex_unlock(&tps->io_lock);
185 return err;
186
187}
188
189static int tps_65023_reg_read(struct tps_pmic *tps, u8 reg)
190{
191 int data;
192
193 mutex_lock(&tps->io_lock);
194
195 data = tps_65023_read(tps, reg);
196 if (data < 0)
197 dev_err(&tps->client->dev, "Read from reg 0x%x failed\n", reg);
198
199 mutex_unlock(&tps->io_lock);
200 return data;
201}
202
203static int tps_65023_reg_write(struct tps_pmic *tps, u8 reg, u8 val)
204{
205 int err;
206
207 mutex_lock(&tps->io_lock);
208
209 err = tps_65023_write(tps, reg, val);
210 if (err < 0)
211 dev_err(&tps->client->dev, "Write for reg 0x%x failed\n", reg);
212
213 mutex_unlock(&tps->io_lock);
214 return err;
215}
216
217static int tps65023_dcdc_is_enabled(struct regulator_dev *dev)
218{
219 struct tps_pmic *tps = rdev_get_drvdata(dev);
220 int data, dcdc = rdev_get_id(dev);
221 u8 shift;
222
223 if (dcdc < TPS65023_DCDC_1 || dcdc > TPS65023_DCDC_3)
224 return -EINVAL;
225
226 shift = TPS65023_NUM_REGULATOR - dcdc;
227 data = tps_65023_reg_read(tps, TPS65023_REG_REG_CTRL);
228
229 if (data < 0)
230 return data;
231 else
232 return (data & 1<<shift) ? 1 : 0;
233}
234
235static int tps65023_ldo_is_enabled(struct regulator_dev *dev)
236{
237 struct tps_pmic *tps = rdev_get_drvdata(dev);
238 int data, ldo = rdev_get_id(dev);
239 u8 shift;
240
241 if (ldo < TPS65023_LDO_1 || ldo > TPS65023_LDO_2)
242 return -EINVAL;
243
244 shift = (ldo == TPS65023_LDO_1 ? 1 : 2);
245 data = tps_65023_reg_read(tps, TPS65023_REG_REG_CTRL);
246
247 if (data < 0)
248 return data;
249 else
250 return (data & 1<<shift) ? 1 : 0;
251}
252
253static int tps65023_dcdc_enable(struct regulator_dev *dev)
254{
255 struct tps_pmic *tps = rdev_get_drvdata(dev);
256 int dcdc = rdev_get_id(dev);
257 u8 shift;
258
259 if (dcdc < TPS65023_DCDC_1 || dcdc > TPS65023_DCDC_3)
260 return -EINVAL;
261
262 shift = TPS65023_NUM_REGULATOR - dcdc;
263 return tps_65023_set_bits(tps, TPS65023_REG_REG_CTRL, 1 << shift);
264}
265
266static int tps65023_dcdc_disable(struct regulator_dev *dev)
267{
268 struct tps_pmic *tps = rdev_get_drvdata(dev);
269 int dcdc = rdev_get_id(dev);
270 u8 shift;
271
272 if (dcdc < TPS65023_DCDC_1 || dcdc > TPS65023_DCDC_3)
273 return -EINVAL;
274
275 shift = TPS65023_NUM_REGULATOR - dcdc;
276 return tps_65023_clear_bits(tps, TPS65023_REG_REG_CTRL, 1 << shift);
277}
278
279static int tps65023_ldo_enable(struct regulator_dev *dev)
280{
281 struct tps_pmic *tps = rdev_get_drvdata(dev);
282 int ldo = rdev_get_id(dev);
283 u8 shift;
284
285 if (ldo < TPS65023_LDO_1 || ldo > TPS65023_LDO_2)
286 return -EINVAL;
287
288 shift = (ldo == TPS65023_LDO_1 ? 1 : 2);
289 return tps_65023_set_bits(tps, TPS65023_REG_REG_CTRL, 1 << shift);
290}
291
292static int tps65023_ldo_disable(struct regulator_dev *dev)
293{
294 struct tps_pmic *tps = rdev_get_drvdata(dev);
295 int ldo = rdev_get_id(dev);
296 u8 shift;
297
298 if (ldo < TPS65023_LDO_1 || ldo > TPS65023_LDO_2)
299 return -EINVAL;
300
301 shift = (ldo == TPS65023_LDO_1 ? 1 : 2);
302 return tps_65023_clear_bits(tps, TPS65023_REG_REG_CTRL, 1 << shift);
303}
304
305static int tps65023_dcdc_get_voltage(struct regulator_dev *dev)
306{
307 struct tps_pmic *tps = rdev_get_drvdata(dev);
308 int data, dcdc = rdev_get_id(dev);
309
310 if (dcdc < TPS65023_DCDC_1 || dcdc > TPS65023_DCDC_3)
311 return -EINVAL;
312
313 if (dcdc == TPS65023_DCDC_1) {
314 data = tps_65023_reg_read(tps, TPS65023_REG_DEF_CORE);
315 if (data < 0)
316 return data;
317 data &= (tps->info[dcdc]->table_len - 1);
318 return tps->info[dcdc]->table[data] * 1000;
319 } else
320 return tps->info[dcdc]->min_uV;
321}
322
323static int tps65023_dcdc_set_voltage(struct regulator_dev *dev,
324 int min_uV, int max_uV,
325 unsigned *selector)
326{
327 struct tps_pmic *tps = rdev_get_drvdata(dev);
328 int dcdc = rdev_get_id(dev);
329 int vsel;
330
331 if (dcdc != TPS65023_DCDC_1)
332 return -EINVAL;
333
334 if (min_uV < tps->info[dcdc]->min_uV
335 || min_uV > tps->info[dcdc]->max_uV)
336 return -EINVAL;
337 if (max_uV < tps->info[dcdc]->min_uV
338 || max_uV > tps->info[dcdc]->max_uV)
339 return -EINVAL;
340
341 for (vsel = 0; vsel < tps->info[dcdc]->table_len; vsel++) {
342 int mV = tps->info[dcdc]->table[vsel];
343 int uV = mV * 1000;
344
345
346 if (min_uV <= uV && uV <= max_uV)
347 break;
348 }
349
350 *selector = vsel;
351
352
353 if (vsel == tps->info[dcdc]->table_len)
354 return -EINVAL;
355 else
356 return tps_65023_reg_write(tps, TPS65023_REG_DEF_CORE, vsel);
357}
358
359static int tps65023_ldo_get_voltage(struct regulator_dev *dev)
360{
361 struct tps_pmic *tps = rdev_get_drvdata(dev);
362 int data, ldo = rdev_get_id(dev);
363
364 if (ldo < TPS65023_LDO_1 || ldo > TPS65023_LDO_2)
365 return -EINVAL;
366
367 data = tps_65023_reg_read(tps, TPS65023_REG_LDO_CTRL);
368 if (data < 0)
369 return data;
370
371 data >>= (TPS65023_LDO_CTRL_LDOx_SHIFT(ldo - TPS65023_LDO_1));
372 data &= (tps->info[ldo]->table_len - 1);
373 return tps->info[ldo]->table[data] * 1000;
374}
375
376static int tps65023_ldo_set_voltage(struct regulator_dev *dev,
377 int min_uV, int max_uV, unsigned *selector)
378{
379 struct tps_pmic *tps = rdev_get_drvdata(dev);
380 int data, vsel, ldo = rdev_get_id(dev);
381
382 if (ldo < TPS65023_LDO_1 || ldo > TPS65023_LDO_2)
383 return -EINVAL;
384
385 if (min_uV < tps->info[ldo]->min_uV || min_uV > tps->info[ldo]->max_uV)
386 return -EINVAL;
387 if (max_uV < tps->info[ldo]->min_uV || max_uV > tps->info[ldo]->max_uV)
388 return -EINVAL;
389
390 for (vsel = 0; vsel < tps->info[ldo]->table_len; vsel++) {
391 int mV = tps->info[ldo]->table[vsel];
392 int uV = mV * 1000;
393
394
395 if (min_uV <= uV && uV <= max_uV)
396 break;
397 }
398
399 if (vsel == tps->info[ldo]->table_len)
400 return -EINVAL;
401
402 *selector = vsel;
403
404 data = tps_65023_reg_read(tps, TPS65023_REG_LDO_CTRL);
405 if (data < 0)
406 return data;
407
408 data &= TPS65023_LDO_CTRL_LDOx_MASK(ldo - TPS65023_LDO_1);
409 data |= (vsel << (TPS65023_LDO_CTRL_LDOx_SHIFT(ldo - TPS65023_LDO_1)));
410 return tps_65023_reg_write(tps, TPS65023_REG_LDO_CTRL, data);
411}
412
413static int tps65023_dcdc_list_voltage(struct regulator_dev *dev,
414 unsigned selector)
415{
416 struct tps_pmic *tps = rdev_get_drvdata(dev);
417 int dcdc = rdev_get_id(dev);
418
419 if (dcdc < TPS65023_DCDC_1 || dcdc > TPS65023_DCDC_3)
420 return -EINVAL;
421
422 if (dcdc == TPS65023_DCDC_1) {
423 if (selector >= tps->info[dcdc]->table_len)
424 return -EINVAL;
425 else
426 return tps->info[dcdc]->table[selector] * 1000;
427 } else
428 return tps->info[dcdc]->min_uV;
429}
430
431static int tps65023_ldo_list_voltage(struct regulator_dev *dev,
432 unsigned selector)
433{
434 struct tps_pmic *tps = rdev_get_drvdata(dev);
435 int ldo = rdev_get_id(dev);
436
437 if (ldo < TPS65023_LDO_1 || ldo > TPS65023_LDO_2)
438 return -EINVAL;
439
440 if (selector >= tps->info[ldo]->table_len)
441 return -EINVAL;
442 else
443 return tps->info[ldo]->table[selector] * 1000;
444}
445
446
447static struct regulator_ops tps65023_dcdc_ops = {
448 .is_enabled = tps65023_dcdc_is_enabled,
449 .enable = tps65023_dcdc_enable,
450 .disable = tps65023_dcdc_disable,
451 .get_voltage = tps65023_dcdc_get_voltage,
452 .set_voltage = tps65023_dcdc_set_voltage,
453 .list_voltage = tps65023_dcdc_list_voltage,
454};
455
456
457static struct regulator_ops tps65023_ldo_ops = {
458 .is_enabled = tps65023_ldo_is_enabled,
459 .enable = tps65023_ldo_enable,
460 .disable = tps65023_ldo_disable,
461 .get_voltage = tps65023_ldo_get_voltage,
462 .set_voltage = tps65023_ldo_set_voltage,
463 .list_voltage = tps65023_ldo_list_voltage,
464};
465
466static int __devinit tps_65023_probe(struct i2c_client *client,
467 const struct i2c_device_id *id)
468{
469 static int desc_id;
470 const struct tps_info *info = (void *)id->driver_data;
471 struct regulator_init_data *init_data;
472 struct regulator_dev *rdev;
473 struct tps_pmic *tps;
474 int i;
475 int error;
476
477 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
478 return -EIO;
479
480
481
482
483
484 init_data = client->dev.platform_data;
485 if (!init_data)
486 return -EIO;
487
488 tps = kzalloc(sizeof(*tps), GFP_KERNEL);
489 if (!tps)
490 return -ENOMEM;
491
492 mutex_init(&tps->io_lock);
493
494
495 tps->client = client;
496
497 for (i = 0; i < TPS65023_NUM_REGULATOR; i++, info++, init_data++) {
498
499 tps->info[i] = info;
500
501 tps->desc[i].name = info->name;
502 tps->desc[i].id = desc_id++;
503 tps->desc[i].n_voltages = num_voltages[i];
504 tps->desc[i].ops = (i > TPS65023_DCDC_3 ?
505 &tps65023_ldo_ops : &tps65023_dcdc_ops);
506 tps->desc[i].type = REGULATOR_VOLTAGE;
507 tps->desc[i].owner = THIS_MODULE;
508
509
510 rdev = regulator_register(&tps->desc[i], &client->dev,
511 init_data, tps);
512 if (IS_ERR(rdev)) {
513 dev_err(&client->dev, "failed to register %s\n",
514 id->name);
515 error = PTR_ERR(rdev);
516 goto fail;
517 }
518
519
520 tps->rdev[i] = rdev;
521 }
522
523 i2c_set_clientdata(client, tps);
524
525 return 0;
526
527 fail:
528 while (--i >= 0)
529 regulator_unregister(tps->rdev[i]);
530
531 kfree(tps);
532 return error;
533}
534
535
536
537
538
539
540
541static int __devexit tps_65023_remove(struct i2c_client *client)
542{
543 struct tps_pmic *tps = i2c_get_clientdata(client);
544 int i;
545
546 for (i = 0; i < TPS65023_NUM_REGULATOR; i++)
547 regulator_unregister(tps->rdev[i]);
548
549 kfree(tps);
550
551 return 0;
552}
553
554static const struct tps_info tps65023_regs[] = {
555 {
556 .name = "VDCDC1",
557 .min_uV = 800000,
558 .max_uV = 1600000,
559 .table_len = ARRAY_SIZE(VDCDC1_VSEL_table),
560 .table = VDCDC1_VSEL_table,
561 },
562 {
563 .name = "VDCDC2",
564 .min_uV = 3300000,
565 .max_uV = 3300000,
566 .fixed = 1,
567 },
568 {
569 .name = "VDCDC3",
570 .min_uV = 1800000,
571 .max_uV = 1800000,
572 .fixed = 1,
573 },
574 {
575 .name = "LDO1",
576 .min_uV = 1000000,
577 .max_uV = 3150000,
578 .table_len = ARRAY_SIZE(LDO1_VSEL_table),
579 .table = LDO1_VSEL_table,
580 },
581 {
582 .name = "LDO2",
583 .min_uV = 1050000,
584 .max_uV = 3300000,
585 .table_len = ARRAY_SIZE(LDO2_VSEL_table),
586 .table = LDO2_VSEL_table,
587 },
588};
589
590static const struct i2c_device_id tps_65023_id[] = {
591 {.name = "tps65023",
592 .driver_data = (unsigned long) tps65023_regs,},
593 {.name = "tps65021",
594 .driver_data = (unsigned long) tps65023_regs,},
595 { },
596};
597
598MODULE_DEVICE_TABLE(i2c, tps_65023_id);
599
600static struct i2c_driver tps_65023_i2c_driver = {
601 .driver = {
602 .name = "tps65023",
603 .owner = THIS_MODULE,
604 },
605 .probe = tps_65023_probe,
606 .remove = __devexit_p(tps_65023_remove),
607 .id_table = tps_65023_id,
608};
609
610
611
612
613
614
615static int __init tps_65023_init(void)
616{
617 return i2c_add_driver(&tps_65023_i2c_driver);
618}
619subsys_initcall(tps_65023_init);
620
621
622
623
624
625
626static void __exit tps_65023_cleanup(void)
627{
628 i2c_del_driver(&tps_65023_i2c_driver);
629}
630module_exit(tps_65023_cleanup);
631
632MODULE_AUTHOR("Texas Instruments");
633MODULE_DESCRIPTION("TPS65023 voltage regulator driver");
634MODULE_LICENSE("GPL v2");
635
