2 * Regulator driver for National Semiconductors LP3972 PMIC chip
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
12 #include <linux/bug.h>
13 #include <linux/err.h>
14 #include <linux/i2c.h>
15 #include <linux/kernel.h>
16 #include <linux/regulator/driver.h>
17 #include <linux/regulator/lp3972.h>
18 #include <linux/slab.h>
23 struct i2c_client *i2c;
25 struct regulator_dev **rdev;
28 /* LP3972 Control Registers */
29 #define LP3972_SCR_REG 0x07
30 #define LP3972_OVER1_REG 0x10
31 #define LP3972_OVSR1_REG 0x11
32 #define LP3972_OVER2_REG 0x12
33 #define LP3972_OVSR2_REG 0x13
34 #define LP3972_VCC1_REG 0x20
35 #define LP3972_ADTV1_REG 0x23
36 #define LP3972_ADTV2_REG 0x24
37 #define LP3972_AVRC_REG 0x25
38 #define LP3972_CDTC1_REG 0x26
39 #define LP3972_CDTC2_REG 0x27
40 #define LP3972_SDTV1_REG 0x29
41 #define LP3972_SDTV2_REG 0x2A
42 #define LP3972_MDTV1_REG 0x32
43 #define LP3972_MDTV2_REG 0x33
44 #define LP3972_L2VCR_REG 0x39
45 #define LP3972_L34VCR_REG 0x3A
46 #define LP3972_SCR1_REG 0x80
47 #define LP3972_SCR2_REG 0x81
48 #define LP3972_OEN3_REG 0x82
49 #define LP3972_OSR3_REG 0x83
50 #define LP3972_LOER4_REG 0x84
51 #define LP3972_B2TV_REG 0x85
52 #define LP3972_B3TV_REG 0x86
53 #define LP3972_B32RC_REG 0x87
54 #define LP3972_ISRA_REG 0x88
55 #define LP3972_BCCR_REG 0x89
56 #define LP3972_II1RR_REG 0x8E
57 #define LP3972_II2RR_REG 0x8F
59 #define LP3972_SYS_CONTROL1_REG LP3972_SCR1_REG
60 /* System control register 1 initial value,
61 * bits 5, 6 and 7 are EPROM programmable */
62 #define SYS_CONTROL1_INIT_VAL 0x02
63 #define SYS_CONTROL1_INIT_MASK 0x1F
65 #define LP3972_VOL_CHANGE_REG LP3972_VCC1_REG
66 #define LP3972_VOL_CHANGE_FLAG_GO 0x01
67 #define LP3972_VOL_CHANGE_FLAG_MASK 0x03
69 /* LDO output enable mask */
70 #define LP3972_OEN3_L1EN BIT(0)
71 #define LP3972_OVER2_LDO2_EN BIT(2)
72 #define LP3972_OVER2_LDO3_EN BIT(3)
73 #define LP3972_OVER2_LDO4_EN BIT(4)
74 #define LP3972_OVER1_S_EN BIT(2)
76 static const int ldo1_voltage_map[] = {
77 1700, 1725, 1750, 1775, 1800, 1825, 1850, 1875,
78 1900, 1925, 1950, 1975, 2000,
81 static const int ldo23_voltage_map[] = {
82 1800, 1900, 2000, 2100, 2200, 2300, 2400, 2500,
83 2600, 2700, 2800, 2900, 3000, 3100, 3200, 3300,
86 static const int ldo4_voltage_map[] = {
87 1000, 1050, 1100, 1150, 1200, 1250, 1300, 1350,
88 1400, 1500, 1800, 1900, 2500, 2800, 3000, 3300,
91 static const int ldo5_voltage_map[] = {
92 0, 0, 0, 0, 0, 850, 875, 900,
93 925, 950, 975, 1000, 1025, 1050, 1075, 1100,
94 1125, 1150, 1175, 1200, 1225, 1250, 1275, 1300,
95 1325, 1350, 1375, 1400, 1425, 1450, 1475, 1500,
98 static const int buck1_voltage_map[] = {
99 725, 750, 775, 800, 825, 850, 875, 900,
100 925, 950, 975, 1000, 1025, 1050, 1075, 1100,
101 1125, 1150, 1175, 1200, 1225, 1250, 1275, 1300,
102 1325, 1350, 1375, 1400, 1425, 1450, 1475, 1500,
105 static const int buck23_voltage_map[] = {
106 0, 800, 850, 900, 950, 1000, 1050, 1100,
107 1150, 1200, 1250, 1300, 1350, 1400, 1450, 1500,
108 1550, 1600, 1650, 1700, 1800, 1900, 2500, 2800,
112 static const int *ldo_voltage_map[] = {
120 static const int *buck_voltage_map[] = {
126 static const int ldo_output_enable_mask[] = {
128 LP3972_OVER2_LDO2_EN,
129 LP3972_OVER2_LDO3_EN,
130 LP3972_OVER2_LDO4_EN,
134 static const int ldo_output_enable_addr[] = {
142 static const int ldo_vol_ctl_addr[] = {
150 static const int buck_vol_enable_addr[] = {
156 static const int buck_base_addr[] = {
162 #define LP3972_LDO_VOL_VALUE_MAP(x) (ldo_voltage_map[x])
163 #define LP3972_LDO_OUTPUT_ENABLE_MASK(x) (ldo_output_enable_mask[x])
164 #define LP3972_LDO_OUTPUT_ENABLE_REG(x) (ldo_output_enable_addr[x])
166 /* LDO voltage control registers shift:
167 LP3972_LDO1 -> 0, LP3972_LDO2 -> 4
168 LP3972_LDO3 -> 0, LP3972_LDO4 -> 4
171 #define LP3972_LDO_VOL_CONTR_SHIFT(x) (((x) & 1) << 2)
172 #define LP3972_LDO_VOL_CONTR_REG(x) (ldo_vol_ctl_addr[x])
173 #define LP3972_LDO_VOL_CHANGE_SHIFT(x) ((x) ? 4 : 6)
175 #define LP3972_LDO_VOL_MASK(x) (((x) % 4) ? 0x0f : 0x1f)
176 #define LP3972_LDO_VOL_MIN_IDX(x) (((x) == 4) ? 0x05 : 0x00)
177 #define LP3972_LDO_VOL_MAX_IDX(x) ((x) ? (((x) == 4) ? 0x1f : 0x0f) : 0x0c)
179 #define LP3972_BUCK_VOL_VALUE_MAP(x) (buck_voltage_map[x])
180 #define LP3972_BUCK_VOL_ENABLE_REG(x) (buck_vol_enable_addr[x])
181 #define LP3972_BUCK_VOL1_REG(x) (buck_base_addr[x])
182 #define LP3972_BUCK_VOL_MASK 0x1f
183 #define LP3972_BUCK_VOL_MIN_IDX(x) ((x) ? 0x01 : 0x00)
184 #define LP3972_BUCK_VOL_MAX_IDX(x) ((x) ? 0x19 : 0x1f)
186 static int lp3972_i2c_read(struct i2c_client *i2c, char reg, int count,
193 ret = i2c_smbus_read_byte_data(i2c, reg);
201 static int lp3972_i2c_write(struct i2c_client *i2c, char reg, int count,
206 return i2c_smbus_write_byte_data(i2c, reg, *src);
209 static u8 lp3972_reg_read(struct lp3972 *lp3972, u8 reg)
213 mutex_lock(&lp3972->io_lock);
215 lp3972_i2c_read(lp3972->i2c, reg, 1, &val);
217 dev_dbg(lp3972->dev, "reg read 0x%02x -> 0x%02x\n", (int)reg,
220 mutex_unlock(&lp3972->io_lock);
225 static int lp3972_set_bits(struct lp3972 *lp3972, u8 reg, u16 mask, u16 val)
230 mutex_lock(&lp3972->io_lock);
232 ret = lp3972_i2c_read(lp3972->i2c, reg, 1, &tmp);
233 tmp = (tmp & ~mask) | val;
235 ret = lp3972_i2c_write(lp3972->i2c, reg, 1, &tmp);
236 dev_dbg(lp3972->dev, "reg write 0x%02x -> 0x%02x\n", (int)reg,
239 mutex_unlock(&lp3972->io_lock);
244 static int lp3972_ldo_list_voltage(struct regulator_dev *dev, unsigned index)
246 int ldo = rdev_get_id(dev) - LP3972_LDO1;
247 return 1000 * LP3972_LDO_VOL_VALUE_MAP(ldo)[index];
250 static int lp3972_ldo_is_enabled(struct regulator_dev *dev)
252 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
253 int ldo = rdev_get_id(dev) - LP3972_LDO1;
254 u16 mask = LP3972_LDO_OUTPUT_ENABLE_MASK(ldo);
257 val = lp3972_reg_read(lp3972, LP3972_LDO_OUTPUT_ENABLE_REG(ldo));
258 return !!(val & mask);
261 static int lp3972_ldo_enable(struct regulator_dev *dev)
263 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
264 int ldo = rdev_get_id(dev) - LP3972_LDO1;
265 u16 mask = LP3972_LDO_OUTPUT_ENABLE_MASK(ldo);
267 return lp3972_set_bits(lp3972, LP3972_LDO_OUTPUT_ENABLE_REG(ldo),
271 static int lp3972_ldo_disable(struct regulator_dev *dev)
273 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
274 int ldo = rdev_get_id(dev) - LP3972_LDO1;
275 u16 mask = LP3972_LDO_OUTPUT_ENABLE_MASK(ldo);
277 return lp3972_set_bits(lp3972, LP3972_LDO_OUTPUT_ENABLE_REG(ldo),
281 static int lp3972_ldo_get_voltage(struct regulator_dev *dev)
283 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
284 int ldo = rdev_get_id(dev) - LP3972_LDO1;
285 u16 mask = LP3972_LDO_VOL_MASK(ldo);
288 reg = lp3972_reg_read(lp3972, LP3972_LDO_VOL_CONTR_REG(ldo));
289 val = (reg >> LP3972_LDO_VOL_CONTR_SHIFT(ldo)) & mask;
291 return 1000 * LP3972_LDO_VOL_VALUE_MAP(ldo)[val];
294 static int lp3972_ldo_set_voltage(struct regulator_dev *dev,
295 int min_uV, int max_uV)
297 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
298 int ldo = rdev_get_id(dev) - LP3972_LDO1;
299 int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
300 const int *vol_map = LP3972_LDO_VOL_VALUE_MAP(ldo);
304 if (min_vol < vol_map[LP3972_LDO_VOL_MIN_IDX(ldo)] ||
305 min_vol > vol_map[LP3972_LDO_VOL_MAX_IDX(ldo)])
308 for (val = LP3972_LDO_VOL_MIN_IDX(ldo);
309 val <= LP3972_LDO_VOL_MAX_IDX(ldo); val++)
310 if (vol_map[val] >= min_vol)
313 if (val > LP3972_LDO_VOL_MAX_IDX(ldo) || vol_map[val] > max_vol)
316 shift = LP3972_LDO_VOL_CONTR_SHIFT(ldo);
317 ret = lp3972_set_bits(lp3972, LP3972_LDO_VOL_CONTR_REG(ldo),
318 LP3972_LDO_VOL_MASK(ldo) << shift, val << shift);
326 shift = LP3972_LDO_VOL_CHANGE_SHIFT(ldo);
327 ret = lp3972_set_bits(lp3972, LP3972_VOL_CHANGE_REG,
328 LP3972_VOL_CHANGE_FLAG_MASK << shift,
329 LP3972_VOL_CHANGE_FLAG_GO << shift);
333 ret = lp3972_set_bits(lp3972, LP3972_VOL_CHANGE_REG,
334 LP3972_VOL_CHANGE_FLAG_MASK << shift, 0);
341 static struct regulator_ops lp3972_ldo_ops = {
342 .list_voltage = lp3972_ldo_list_voltage,
343 .is_enabled = lp3972_ldo_is_enabled,
344 .enable = lp3972_ldo_enable,
345 .disable = lp3972_ldo_disable,
346 .get_voltage = lp3972_ldo_get_voltage,
347 .set_voltage = lp3972_ldo_set_voltage,
350 static int lp3972_dcdc_list_voltage(struct regulator_dev *dev, unsigned index)
352 int buck = rdev_get_id(dev) - LP3972_DCDC1;
353 return 1000 * buck_voltage_map[buck][index];
356 static int lp3972_dcdc_is_enabled(struct regulator_dev *dev)
358 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
359 int buck = rdev_get_id(dev) - LP3972_DCDC1;
360 u16 mask = 1 << (buck * 2);
363 val = lp3972_reg_read(lp3972, LP3972_BUCK_VOL_ENABLE_REG(buck));
364 return !!(val & mask);
367 static int lp3972_dcdc_enable(struct regulator_dev *dev)
369 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
370 int buck = rdev_get_id(dev) - LP3972_DCDC1;
371 u16 mask = 1 << (buck * 2);
374 val = lp3972_set_bits(lp3972, LP3972_BUCK_VOL_ENABLE_REG(buck),
379 static int lp3972_dcdc_disable(struct regulator_dev *dev)
381 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
382 int buck = rdev_get_id(dev) - LP3972_DCDC1;
383 u16 mask = 1 << (buck * 2);
386 val = lp3972_set_bits(lp3972, LP3972_BUCK_VOL_ENABLE_REG(buck),
391 static int lp3972_dcdc_get_voltage(struct regulator_dev *dev)
393 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
394 int buck = rdev_get_id(dev) - LP3972_DCDC1;
398 reg = lp3972_reg_read(lp3972, LP3972_BUCK_VOL1_REG(buck));
399 reg &= LP3972_BUCK_VOL_MASK;
400 if (reg <= LP3972_BUCK_VOL_MAX_IDX(buck))
401 val = 1000 * buck_voltage_map[buck][reg];
404 dev_warn(&dev->dev, "chip reported incorrect voltage value.\n");
410 static int lp3972_dcdc_set_voltage(struct regulator_dev *dev,
411 int min_uV, int max_uV)
413 struct lp3972 *lp3972 = rdev_get_drvdata(dev);
414 int buck = rdev_get_id(dev) - LP3972_DCDC1;
415 int min_vol = min_uV / 1000, max_vol = max_uV / 1000;
416 const int *vol_map = buck_voltage_map[buck];
420 if (min_vol < vol_map[LP3972_BUCK_VOL_MIN_IDX(buck)] ||
421 min_vol > vol_map[LP3972_BUCK_VOL_MAX_IDX(buck)])
424 for (val = LP3972_BUCK_VOL_MIN_IDX(buck);
425 val <= LP3972_BUCK_VOL_MAX_IDX(buck); val++)
426 if (vol_map[val] >= min_vol)
429 if (val > LP3972_BUCK_VOL_MAX_IDX(buck) ||
430 vol_map[val] > max_vol)
433 ret = lp3972_set_bits(lp3972, LP3972_BUCK_VOL1_REG(buck),
434 LP3972_BUCK_VOL_MASK, val);
441 ret = lp3972_set_bits(lp3972, LP3972_VOL_CHANGE_REG,
442 LP3972_VOL_CHANGE_FLAG_MASK, LP3972_VOL_CHANGE_FLAG_GO);
446 return lp3972_set_bits(lp3972, LP3972_VOL_CHANGE_REG,
447 LP3972_VOL_CHANGE_FLAG_MASK, 0);
450 static struct regulator_ops lp3972_dcdc_ops = {
451 .list_voltage = lp3972_dcdc_list_voltage,
452 .is_enabled = lp3972_dcdc_is_enabled,
453 .enable = lp3972_dcdc_enable,
454 .disable = lp3972_dcdc_disable,
455 .get_voltage = lp3972_dcdc_get_voltage,
456 .set_voltage = lp3972_dcdc_set_voltage,
459 static struct regulator_desc regulators[] = {
463 .ops = &lp3972_ldo_ops,
464 .n_voltages = ARRAY_SIZE(ldo1_voltage_map),
465 .type = REGULATOR_VOLTAGE,
466 .owner = THIS_MODULE,
471 .ops = &lp3972_ldo_ops,
472 .n_voltages = ARRAY_SIZE(ldo23_voltage_map),
473 .type = REGULATOR_VOLTAGE,
474 .owner = THIS_MODULE,
479 .ops = &lp3972_ldo_ops,
480 .n_voltages = ARRAY_SIZE(ldo23_voltage_map),
481 .type = REGULATOR_VOLTAGE,
482 .owner = THIS_MODULE,
487 .ops = &lp3972_ldo_ops,
488 .n_voltages = ARRAY_SIZE(ldo4_voltage_map),
489 .type = REGULATOR_VOLTAGE,
490 .owner = THIS_MODULE,
495 .ops = &lp3972_ldo_ops,
496 .n_voltages = ARRAY_SIZE(ldo5_voltage_map),
497 .type = REGULATOR_VOLTAGE,
498 .owner = THIS_MODULE,
503 .ops = &lp3972_dcdc_ops,
504 .n_voltages = ARRAY_SIZE(buck1_voltage_map),
505 .type = REGULATOR_VOLTAGE,
506 .owner = THIS_MODULE,
511 .ops = &lp3972_dcdc_ops,
512 .n_voltages = ARRAY_SIZE(buck23_voltage_map),
513 .type = REGULATOR_VOLTAGE,
514 .owner = THIS_MODULE,
519 .ops = &lp3972_dcdc_ops,
520 .n_voltages = ARRAY_SIZE(buck23_voltage_map),
521 .type = REGULATOR_VOLTAGE,
522 .owner = THIS_MODULE,
526 static int setup_regulators(struct lp3972 *lp3972,
527 struct lp3972_platform_data *pdata)
531 lp3972->num_regulators = pdata->num_regulators;
532 lp3972->rdev = kcalloc(pdata->num_regulators,
533 sizeof(struct regulator_dev *), GFP_KERNEL);
539 /* Instantiate the regulators */
540 for (i = 0; i < pdata->num_regulators; i++) {
541 struct lp3972_regulator_subdev *reg = &pdata->regulators[i];
542 lp3972->rdev[i] = regulator_register(®ulators[reg->id],
543 lp3972->dev, reg->initdata, lp3972);
545 if (IS_ERR(lp3972->rdev[i])) {
546 err = PTR_ERR(lp3972->rdev[i]);
547 dev_err(lp3972->dev, "regulator init failed: %d\n",
556 regulator_unregister(lp3972->rdev[i]);
563 static int __devinit lp3972_i2c_probe(struct i2c_client *i2c,
564 const struct i2c_device_id *id)
566 struct lp3972 *lp3972;
567 struct lp3972_platform_data *pdata = i2c->dev.platform_data;
572 dev_dbg(&i2c->dev, "No platform init data supplied\n");
576 lp3972 = kzalloc(sizeof(struct lp3972), GFP_KERNEL);
581 lp3972->dev = &i2c->dev;
583 mutex_init(&lp3972->io_lock);
586 ret = lp3972_i2c_read(i2c, LP3972_SYS_CONTROL1_REG, 1, &val);
587 if (ret == 0 && (val & SYS_CONTROL1_INIT_MASK) != SYS_CONTROL1_INIT_VAL)
590 dev_err(&i2c->dev, "failed to detect device\n");
594 ret = setup_regulators(lp3972, pdata);
598 i2c_set_clientdata(i2c, lp3972);
606 static int __devexit lp3972_i2c_remove(struct i2c_client *i2c)
608 struct lp3972 *lp3972 = i2c_get_clientdata(i2c);
611 for (i = 0; i < lp3972->num_regulators; i++)
612 regulator_unregister(lp3972->rdev[i]);
619 static const struct i2c_device_id lp3972_i2c_id[] = {
623 MODULE_DEVICE_TABLE(i2c, lp3972_i2c_id);
625 static struct i2c_driver lp3972_i2c_driver = {
628 .owner = THIS_MODULE,
630 .probe = lp3972_i2c_probe,
631 .remove = __devexit_p(lp3972_i2c_remove),
632 .id_table = lp3972_i2c_id,
635 static int __init lp3972_module_init(void)
637 return i2c_add_driver(&lp3972_i2c_driver);
639 subsys_initcall(lp3972_module_init);
641 static void __exit lp3972_module_exit(void)
643 i2c_del_driver(&lp3972_i2c_driver);
645 module_exit(lp3972_module_exit);
647 MODULE_LICENSE("GPL");
648 MODULE_AUTHOR("Axel Lin <axel.lin@gmail.com>");
649 MODULE_DESCRIPTION("LP3972 PMIC driver");