x86/xen: resume timer irqs early
[linux/fpc-iii.git] / drivers / regulator / tps80031-regulator.c
blob6511d0bfd8964ecba4861dfd30c91d727c39ef25
1 /*
2 * tps80031-regulator.c -- TI TPS80031 regulator driver.
4 * Regulator driver for TI TPS80031/TPS80032 Fully Integrated Power
5 * Management with Power Path and Battery Charger.
7 * Copyright (c) 2012, NVIDIA Corporation.
9 * Author: Laxman Dewangan <ldewangan@nvidia.com>
11 * This program is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License as
13 * published by the Free Software Foundation version 2.
15 * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
16 * whether express or implied; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
18 * General Public License for more details.
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
23 * 02111-1307, USA
26 #include <linux/delay.h>
27 #include <linux/err.h>
28 #include <linux/init.h>
29 #include <linux/kernel.h>
30 #include <linux/mfd/tps80031.h>
31 #include <linux/module.h>
32 #include <linux/platform_device.h>
33 #include <linux/regulator/driver.h>
34 #include <linux/regulator/machine.h>
35 #include <linux/slab.h>
37 /* Flags for DCDC Voltage reading */
38 #define DCDC_OFFSET_EN BIT(0)
39 #define DCDC_EXTENDED_EN BIT(1)
40 #define TRACK_MODE_ENABLE BIT(2)
42 #define SMPS_MULTOFFSET_VIO BIT(1)
43 #define SMPS_MULTOFFSET_SMPS1 BIT(3)
44 #define SMPS_MULTOFFSET_SMPS2 BIT(4)
45 #define SMPS_MULTOFFSET_SMPS3 BIT(6)
46 #define SMPS_MULTOFFSET_SMPS4 BIT(0)
48 #define SMPS_CMD_MASK 0xC0
49 #define SMPS_VSEL_MASK 0x3F
50 #define LDO_VSEL_MASK 0x1F
51 #define LDO_TRACK_VSEL_MASK 0x3F
53 #define MISC2_LDOUSB_IN_VSYS BIT(4)
54 #define MISC2_LDOUSB_IN_PMID BIT(3)
55 #define MISC2_LDOUSB_IN_MASK 0x18
57 #define MISC2_LDO3_SEL_VIB_VAL BIT(0)
58 #define MISC2_LDO3_SEL_VIB_MASK 0x1
60 #define BOOST_HW_PWR_EN BIT(5)
61 #define BOOST_HW_PWR_EN_MASK BIT(5)
63 #define OPA_MODE_EN BIT(6)
64 #define OPA_MODE_EN_MASK BIT(6)
66 #define USB_VBUS_CTRL_SET 0x04
67 #define USB_VBUS_CTRL_CLR 0x05
68 #define VBUS_DISCHRG 0x20
70 struct tps80031_regulator_info {
71 /* Regulator register address.*/
72 u8 trans_reg;
73 u8 state_reg;
74 u8 force_reg;
75 u8 volt_reg;
76 u8 volt_id;
78 /*Power request bits */
79 int preq_bit;
81 /* used by regulator core */
82 struct regulator_desc desc;
86 struct tps80031_regulator {
87 struct device *dev;
88 struct regulator_dev *rdev;
89 struct tps80031_regulator_info *rinfo;
91 u8 device_flags;
92 unsigned int config_flags;
93 unsigned int ext_ctrl_flag;
96 static inline struct device *to_tps80031_dev(struct regulator_dev *rdev)
98 return rdev_get_dev(rdev)->parent->parent;
101 static int tps80031_reg_is_enabled(struct regulator_dev *rdev)
103 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
104 struct device *parent = to_tps80031_dev(rdev);
105 u8 reg_val;
106 int ret;
108 if (ri->ext_ctrl_flag & TPS80031_EXT_PWR_REQ)
109 return true;
111 ret = tps80031_read(parent, TPS80031_SLAVE_ID1, ri->rinfo->state_reg,
112 &reg_val);
113 if (ret < 0) {
114 dev_err(&rdev->dev, "Reg 0x%02x read failed, err = %d\n",
115 ri->rinfo->state_reg, ret);
116 return ret;
118 return ((reg_val & TPS80031_STATE_MASK) == TPS80031_STATE_ON);
121 static int tps80031_reg_enable(struct regulator_dev *rdev)
123 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
124 struct device *parent = to_tps80031_dev(rdev);
125 int ret;
127 if (ri->ext_ctrl_flag & TPS80031_EXT_PWR_REQ)
128 return 0;
130 ret = tps80031_update(parent, TPS80031_SLAVE_ID1, ri->rinfo->state_reg,
131 TPS80031_STATE_ON, TPS80031_STATE_MASK);
132 if (ret < 0) {
133 dev_err(&rdev->dev, "Reg 0x%02x update failed, err = %d\n",
134 ri->rinfo->state_reg, ret);
135 return ret;
137 return ret;
140 static int tps80031_reg_disable(struct regulator_dev *rdev)
142 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
143 struct device *parent = to_tps80031_dev(rdev);
144 int ret;
146 if (ri->ext_ctrl_flag & TPS80031_EXT_PWR_REQ)
147 return 0;
149 ret = tps80031_update(parent, TPS80031_SLAVE_ID1, ri->rinfo->state_reg,
150 TPS80031_STATE_OFF, TPS80031_STATE_MASK);
151 if (ret < 0)
152 dev_err(&rdev->dev, "Reg 0x%02x update failed, err = %d\n",
153 ri->rinfo->state_reg, ret);
154 return ret;
157 /* DCDC voltages for the selector of 58 to 63 */
158 static int tps80031_dcdc_voltages[4][5] = {
159 { 1350, 1500, 1800, 1900, 2100},
160 { 1350, 1500, 1800, 1900, 2100},
161 { 2084, 2315, 2778, 2932, 3241},
162 { 4167, 2315, 2778, 2932, 3241},
165 static int tps80031_dcdc_list_voltage(struct regulator_dev *rdev, unsigned sel)
167 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
168 int volt_index = ri->device_flags & 0x3;
170 if (sel == 0)
171 return 0;
172 else if (sel < 58)
173 return regulator_list_voltage_linear(rdev, sel - 1);
174 else
175 return tps80031_dcdc_voltages[volt_index][sel - 58] * 1000;
178 static int tps80031_dcdc_set_voltage_sel(struct regulator_dev *rdev,
179 unsigned vsel)
181 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
182 struct device *parent = to_tps80031_dev(rdev);
183 int ret;
184 u8 reg_val;
186 if (ri->rinfo->force_reg) {
187 ret = tps80031_read(parent, ri->rinfo->volt_id,
188 ri->rinfo->force_reg, &reg_val);
189 if (ret < 0) {
190 dev_err(ri->dev, "reg 0x%02x read failed, e = %d\n",
191 ri->rinfo->force_reg, ret);
192 return ret;
194 if (!(reg_val & SMPS_CMD_MASK)) {
195 ret = tps80031_update(parent, ri->rinfo->volt_id,
196 ri->rinfo->force_reg, vsel, SMPS_VSEL_MASK);
197 if (ret < 0)
198 dev_err(ri->dev,
199 "reg 0x%02x update failed, e = %d\n",
200 ri->rinfo->force_reg, ret);
201 return ret;
204 ret = tps80031_update(parent, ri->rinfo->volt_id,
205 ri->rinfo->volt_reg, vsel, SMPS_VSEL_MASK);
206 if (ret < 0)
207 dev_err(ri->dev, "reg 0x%02x update failed, e = %d\n",
208 ri->rinfo->volt_reg, ret);
209 return ret;
212 static int tps80031_dcdc_get_voltage_sel(struct regulator_dev *rdev)
214 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
215 struct device *parent = to_tps80031_dev(rdev);
216 uint8_t vsel = 0;
217 int ret;
219 if (ri->rinfo->force_reg) {
220 ret = tps80031_read(parent, ri->rinfo->volt_id,
221 ri->rinfo->force_reg, &vsel);
222 if (ret < 0) {
223 dev_err(ri->dev, "reg 0x%02x read failed, e = %d\n",
224 ri->rinfo->force_reg, ret);
225 return ret;
228 if (!(vsel & SMPS_CMD_MASK))
229 return vsel & SMPS_VSEL_MASK;
231 ret = tps80031_read(parent, ri->rinfo->volt_id,
232 ri->rinfo->volt_reg, &vsel);
233 if (ret < 0) {
234 dev_err(ri->dev, "reg 0x%02x read failed, e = %d\n",
235 ri->rinfo->volt_reg, ret);
236 return ret;
238 return vsel & SMPS_VSEL_MASK;
241 static int tps80031_ldo_list_voltage(struct regulator_dev *rdev,
242 unsigned int sel)
244 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
245 struct device *parent = to_tps80031_dev(rdev);
247 /* Check for valid setting for TPS80031 or TPS80032-ES1.0 */
248 if ((ri->rinfo->desc.id == TPS80031_REGULATOR_LDO2) &&
249 (ri->device_flags & TRACK_MODE_ENABLE)) {
250 unsigned nvsel = (sel) & 0x1F;
251 if (((tps80031_get_chip_info(parent) == TPS80031) ||
252 ((tps80031_get_chip_info(parent) == TPS80032) &&
253 (tps80031_get_pmu_version(parent) == 0x0))) &&
254 ((nvsel == 0x0) || (nvsel >= 0x19 && nvsel <= 0x1F))) {
255 dev_err(ri->dev,
256 "Invalid sel %d in track mode LDO2\n",
257 nvsel);
258 return -EINVAL;
262 return regulator_list_voltage_linear(rdev, sel);
265 static int tps80031_ldo_map_voltage(struct regulator_dev *rdev,
266 int min_uV, int max_uV)
268 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
269 struct device *parent = to_tps80031_dev(rdev);
271 /* Check for valid setting for TPS80031 or TPS80032-ES1.0 */
272 if ((ri->rinfo->desc.id == TPS80031_REGULATOR_LDO2) &&
273 (ri->device_flags & TRACK_MODE_ENABLE)) {
274 if (((tps80031_get_chip_info(parent) == TPS80031) ||
275 ((tps80031_get_chip_info(parent) == TPS80032) &&
276 (tps80031_get_pmu_version(parent) == 0x0)))) {
277 return regulator_map_voltage_iterate(rdev, min_uV,
278 max_uV);
282 return regulator_map_voltage_linear(rdev, min_uV, max_uV);
285 static int tps80031_vbus_is_enabled(struct regulator_dev *rdev)
287 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
288 struct device *parent = to_tps80031_dev(rdev);
289 int ret = -EIO;
290 uint8_t ctrl1 = 0;
291 uint8_t ctrl3 = 0;
293 ret = tps80031_read(parent, TPS80031_SLAVE_ID2,
294 TPS80031_CHARGERUSB_CTRL1, &ctrl1);
295 if (ret < 0) {
296 dev_err(ri->dev, "reg 0x%02x read failed, e = %d\n",
297 TPS80031_CHARGERUSB_CTRL1, ret);
298 return ret;
300 ret = tps80031_read(parent, TPS80031_SLAVE_ID2,
301 TPS80031_CHARGERUSB_CTRL3, &ctrl3);
302 if (ret < 0) {
303 dev_err(ri->dev, "reg 0x%02x read failed, e = %d\n",
304 TPS80031_CHARGERUSB_CTRL3, ret);
305 return ret;
307 if ((ctrl1 & OPA_MODE_EN) && (ctrl3 & BOOST_HW_PWR_EN))
308 return 1;
309 return ret;
312 static int tps80031_vbus_enable(struct regulator_dev *rdev)
314 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
315 struct device *parent = to_tps80031_dev(rdev);
316 int ret;
318 ret = tps80031_set_bits(parent, TPS80031_SLAVE_ID2,
319 TPS80031_CHARGERUSB_CTRL1, OPA_MODE_EN);
320 if (ret < 0) {
321 dev_err(ri->dev, "reg 0x%02x read failed, e = %d\n",
322 TPS80031_CHARGERUSB_CTRL1, ret);
323 return ret;
326 ret = tps80031_set_bits(parent, TPS80031_SLAVE_ID2,
327 TPS80031_CHARGERUSB_CTRL3, BOOST_HW_PWR_EN);
328 if (ret < 0) {
329 dev_err(ri->dev, "reg 0x%02x read failed, e = %d\n",
330 TPS80031_CHARGERUSB_CTRL3, ret);
331 return ret;
333 return ret;
336 static int tps80031_vbus_disable(struct regulator_dev *rdev)
338 struct tps80031_regulator *ri = rdev_get_drvdata(rdev);
339 struct device *parent = to_tps80031_dev(rdev);
340 int ret = 0;
342 if (ri->config_flags & TPS80031_VBUS_DISCHRG_EN_PDN) {
343 ret = tps80031_write(parent, TPS80031_SLAVE_ID2,
344 USB_VBUS_CTRL_SET, VBUS_DISCHRG);
345 if (ret < 0) {
346 dev_err(ri->dev, "reg 0x%02x write failed, e = %d\n",
347 USB_VBUS_CTRL_SET, ret);
348 return ret;
352 ret = tps80031_clr_bits(parent, TPS80031_SLAVE_ID2,
353 TPS80031_CHARGERUSB_CTRL1, OPA_MODE_EN);
354 if (ret < 0) {
355 dev_err(ri->dev, "reg 0x%02x clearbit failed, e = %d\n",
356 TPS80031_CHARGERUSB_CTRL1, ret);
357 return ret;
360 ret = tps80031_clr_bits(parent, TPS80031_SLAVE_ID2,
361 TPS80031_CHARGERUSB_CTRL3, BOOST_HW_PWR_EN);
362 if (ret < 0) {
363 dev_err(ri->dev, "reg 0x%02x clearbit failed, e = %d\n",
364 TPS80031_CHARGERUSB_CTRL3, ret);
365 return ret;
368 mdelay(DIV_ROUND_UP(ri->rinfo->desc.enable_time, 1000));
369 if (ri->config_flags & TPS80031_VBUS_DISCHRG_EN_PDN) {
370 ret = tps80031_write(parent, TPS80031_SLAVE_ID2,
371 USB_VBUS_CTRL_CLR, VBUS_DISCHRG);
372 if (ret < 0) {
373 dev_err(ri->dev, "reg 0x%02x write failed, e = %d\n",
374 USB_VBUS_CTRL_CLR, ret);
375 return ret;
378 return ret;
381 static struct regulator_ops tps80031_dcdc_ops = {
382 .list_voltage = tps80031_dcdc_list_voltage,
383 .set_voltage_sel = tps80031_dcdc_set_voltage_sel,
384 .get_voltage_sel = tps80031_dcdc_get_voltage_sel,
385 .enable = tps80031_reg_enable,
386 .disable = tps80031_reg_disable,
387 .is_enabled = tps80031_reg_is_enabled,
390 static struct regulator_ops tps80031_ldo_ops = {
391 .list_voltage = tps80031_ldo_list_voltage,
392 .map_voltage = tps80031_ldo_map_voltage,
393 .set_voltage_sel = regulator_set_voltage_sel_regmap,
394 .get_voltage_sel = regulator_get_voltage_sel_regmap,
395 .enable = tps80031_reg_enable,
396 .disable = tps80031_reg_disable,
397 .is_enabled = tps80031_reg_is_enabled,
400 static struct regulator_ops tps80031_vbus_sw_ops = {
401 .list_voltage = regulator_list_voltage_linear,
402 .enable = tps80031_vbus_enable,
403 .disable = tps80031_vbus_disable,
404 .is_enabled = tps80031_vbus_is_enabled,
407 static struct regulator_ops tps80031_vbus_hw_ops = {
408 .list_voltage = regulator_list_voltage_linear,
411 static struct regulator_ops tps80031_ext_reg_ops = {
412 .list_voltage = regulator_list_voltage_linear,
413 .enable = tps80031_reg_enable,
414 .disable = tps80031_reg_disable,
415 .is_enabled = tps80031_reg_is_enabled,
418 /* Non-exiting default definition for some register */
419 #define TPS80031_SMPS3_CFG_FORCE 0
420 #define TPS80031_SMPS4_CFG_FORCE 0
422 #define TPS80031_VBUS_CFG_TRANS 0
423 #define TPS80031_VBUS_CFG_STATE 0
425 #define TPS80031_REG_SMPS(_id, _volt_id, _pbit) \
427 .trans_reg = TPS80031_##_id##_CFG_TRANS, \
428 .state_reg = TPS80031_##_id##_CFG_STATE, \
429 .force_reg = TPS80031_##_id##_CFG_FORCE, \
430 .volt_reg = TPS80031_##_id##_CFG_VOLTAGE, \
431 .volt_id = TPS80031_SLAVE_##_volt_id, \
432 .preq_bit = _pbit, \
433 .desc = { \
434 .name = "tps80031_"#_id, \
435 .id = TPS80031_REGULATOR_##_id, \
436 .n_voltages = 63, \
437 .ops = &tps80031_dcdc_ops, \
438 .type = REGULATOR_VOLTAGE, \
439 .owner = THIS_MODULE, \
440 .enable_time = 500, \
441 }, \
444 #define TPS80031_REG_LDO(_id, _preq_bit) \
446 .trans_reg = TPS80031_##_id##_CFG_TRANS, \
447 .state_reg = TPS80031_##_id##_CFG_STATE, \
448 .volt_reg = TPS80031_##_id##_CFG_VOLTAGE, \
449 .volt_id = TPS80031_SLAVE_ID1, \
450 .preq_bit = _preq_bit, \
451 .desc = { \
452 .owner = THIS_MODULE, \
453 .name = "tps80031_"#_id, \
454 .id = TPS80031_REGULATOR_##_id, \
455 .ops = &tps80031_ldo_ops, \
456 .type = REGULATOR_VOLTAGE, \
457 .min_uV = 1000000, \
458 .uV_step = 100000, \
459 .linear_min_sel = 1, \
460 .n_voltages = 25, \
461 .vsel_reg = TPS80031_##_id##_CFG_VOLTAGE, \
462 .vsel_mask = LDO_VSEL_MASK, \
463 .enable_time = 500, \
464 }, \
467 #define TPS80031_REG_FIXED(_id, max_mV, _ops, _delay, _pbit) \
469 .trans_reg = TPS80031_##_id##_CFG_TRANS, \
470 .state_reg = TPS80031_##_id##_CFG_STATE, \
471 .volt_id = TPS80031_SLAVE_ID1, \
472 .preq_bit = _pbit, \
473 .desc = { \
474 .name = "tps80031_"#_id, \
475 .id = TPS80031_REGULATOR_##_id, \
476 .min_uV = max_mV * 1000, \
477 .n_voltages = 1, \
478 .ops = &_ops, \
479 .type = REGULATOR_VOLTAGE, \
480 .owner = THIS_MODULE, \
481 .enable_time = _delay, \
482 }, \
485 static struct tps80031_regulator_info tps80031_rinfo[TPS80031_REGULATOR_MAX] = {
486 TPS80031_REG_SMPS(VIO, ID0, 4),
487 TPS80031_REG_SMPS(SMPS1, ID0, 0),
488 TPS80031_REG_SMPS(SMPS2, ID0, 1),
489 TPS80031_REG_SMPS(SMPS3, ID1, 2),
490 TPS80031_REG_SMPS(SMPS4, ID1, 3),
491 TPS80031_REG_LDO(VANA, -1),
492 TPS80031_REG_LDO(LDO1, 8),
493 TPS80031_REG_LDO(LDO2, 9),
494 TPS80031_REG_LDO(LDO3, 10),
495 TPS80031_REG_LDO(LDO4, 11),
496 TPS80031_REG_LDO(LDO5, 12),
497 TPS80031_REG_LDO(LDO6, 13),
498 TPS80031_REG_LDO(LDO7, 14),
499 TPS80031_REG_LDO(LDOLN, 15),
500 TPS80031_REG_LDO(LDOUSB, 5),
501 TPS80031_REG_FIXED(VBUS, 5000, tps80031_vbus_hw_ops, 100000, -1),
502 TPS80031_REG_FIXED(REGEN1, 3300, tps80031_ext_reg_ops, 0, 16),
503 TPS80031_REG_FIXED(REGEN2, 3300, tps80031_ext_reg_ops, 0, 17),
504 TPS80031_REG_FIXED(SYSEN, 3300, tps80031_ext_reg_ops, 0, 18),
507 static int tps80031_power_req_config(struct device *parent,
508 struct tps80031_regulator *ri,
509 struct tps80031_regulator_platform_data *tps80031_pdata)
511 int ret = 0;
513 if (ri->rinfo->preq_bit < 0)
514 goto skip_pwr_req_config;
516 ret = tps80031_ext_power_req_config(parent, ri->ext_ctrl_flag,
517 ri->rinfo->preq_bit, ri->rinfo->state_reg,
518 ri->rinfo->trans_reg);
519 if (ret < 0) {
520 dev_err(ri->dev, "ext powerreq config failed, err = %d\n", ret);
521 return ret;
524 skip_pwr_req_config:
525 if (tps80031_pdata->ext_ctrl_flag & TPS80031_PWR_ON_ON_SLEEP) {
526 ret = tps80031_update(parent, TPS80031_SLAVE_ID1,
527 ri->rinfo->trans_reg, TPS80031_TRANS_SLEEP_ON,
528 TPS80031_TRANS_SLEEP_MASK);
529 if (ret < 0) {
530 dev_err(ri->dev, "Reg 0x%02x update failed, e %d\n",
531 ri->rinfo->trans_reg, ret);
532 return ret;
535 return ret;
538 static int tps80031_regulator_config(struct device *parent,
539 struct tps80031_regulator *ri,
540 struct tps80031_regulator_platform_data *tps80031_pdata)
542 int ret = 0;
544 switch (ri->rinfo->desc.id) {
545 case TPS80031_REGULATOR_LDOUSB:
546 if (ri->config_flags & (TPS80031_USBLDO_INPUT_VSYS |
547 TPS80031_USBLDO_INPUT_PMID)) {
548 unsigned val = 0;
549 if (ri->config_flags & TPS80031_USBLDO_INPUT_VSYS)
550 val = MISC2_LDOUSB_IN_VSYS;
551 else
552 val = MISC2_LDOUSB_IN_PMID;
554 ret = tps80031_update(parent, TPS80031_SLAVE_ID1,
555 TPS80031_MISC2, val,
556 MISC2_LDOUSB_IN_MASK);
557 if (ret < 0) {
558 dev_err(ri->dev,
559 "LDOUSB config failed, e= %d\n", ret);
560 return ret;
563 break;
565 case TPS80031_REGULATOR_LDO3:
566 if (ri->config_flags & TPS80031_LDO3_OUTPUT_VIB) {
567 ret = tps80031_update(parent, TPS80031_SLAVE_ID1,
568 TPS80031_MISC2, MISC2_LDO3_SEL_VIB_VAL,
569 MISC2_LDO3_SEL_VIB_MASK);
570 if (ret < 0) {
571 dev_err(ri->dev,
572 "LDO3 config failed, e = %d\n", ret);
573 return ret;
576 break;
578 case TPS80031_REGULATOR_VBUS:
579 /* Provide SW control Ops if VBUS is SW control */
580 if (!(ri->config_flags & TPS80031_VBUS_SW_ONLY))
581 ri->rinfo->desc.ops = &tps80031_vbus_sw_ops;
582 break;
583 default:
584 break;
587 /* Configure Active state to ON, SLEEP to OFF and OFF_state to OFF */
588 ret = tps80031_update(parent, TPS80031_SLAVE_ID1, ri->rinfo->trans_reg,
589 TPS80031_TRANS_ACTIVE_ON | TPS80031_TRANS_SLEEP_OFF |
590 TPS80031_TRANS_OFF_OFF, TPS80031_TRANS_ACTIVE_MASK |
591 TPS80031_TRANS_SLEEP_MASK | TPS80031_TRANS_OFF_MASK);
592 if (ret < 0) {
593 dev_err(ri->dev, "trans reg update failed, e %d\n", ret);
594 return ret;
597 return ret;
600 static int check_smps_mode_mult(struct device *parent,
601 struct tps80031_regulator *ri)
603 int mult_offset;
604 int ret;
605 u8 smps_offset;
606 u8 smps_mult;
608 ret = tps80031_read(parent, TPS80031_SLAVE_ID1,
609 TPS80031_SMPS_OFFSET, &smps_offset);
610 if (ret < 0) {
611 dev_err(parent, "Error in reading smps offset register\n");
612 return ret;
615 ret = tps80031_read(parent, TPS80031_SLAVE_ID1,
616 TPS80031_SMPS_MULT, &smps_mult);
617 if (ret < 0) {
618 dev_err(parent, "Error in reading smps mult register\n");
619 return ret;
622 switch (ri->rinfo->desc.id) {
623 case TPS80031_REGULATOR_VIO:
624 mult_offset = SMPS_MULTOFFSET_VIO;
625 break;
626 case TPS80031_REGULATOR_SMPS1:
627 mult_offset = SMPS_MULTOFFSET_SMPS1;
628 break;
629 case TPS80031_REGULATOR_SMPS2:
630 mult_offset = SMPS_MULTOFFSET_SMPS2;
631 break;
632 case TPS80031_REGULATOR_SMPS3:
633 mult_offset = SMPS_MULTOFFSET_SMPS3;
634 break;
635 case TPS80031_REGULATOR_SMPS4:
636 mult_offset = SMPS_MULTOFFSET_SMPS4;
637 break;
638 case TPS80031_REGULATOR_LDO2:
639 ri->device_flags = smps_mult & BIT(5) ? TRACK_MODE_ENABLE : 0;
640 /* TRACK mode the ldo2 varies from 600mV to 1300mV */
641 if (ri->device_flags & TRACK_MODE_ENABLE) {
642 ri->rinfo->desc.min_uV = 600000;
643 ri->rinfo->desc.uV_step = 12500;
644 ri->rinfo->desc.n_voltages = 57;
645 ri->rinfo->desc.vsel_mask = LDO_TRACK_VSEL_MASK;
647 return 0;
648 default:
649 return 0;
652 ri->device_flags = (smps_offset & mult_offset) ? DCDC_OFFSET_EN : 0;
653 ri->device_flags |= (smps_mult & mult_offset) ? DCDC_EXTENDED_EN : 0;
654 switch (ri->device_flags) {
655 case 0:
656 ri->rinfo->desc.min_uV = 607700;
657 ri->rinfo->desc.uV_step = 12660;
658 break;
659 case DCDC_OFFSET_EN:
660 ri->rinfo->desc.min_uV = 700000;
661 ri->rinfo->desc.uV_step = 12500;
662 break;
663 case DCDC_EXTENDED_EN:
664 ri->rinfo->desc.min_uV = 1852000;
665 ri->rinfo->desc.uV_step = 38600;
666 break;
667 case DCDC_OFFSET_EN | DCDC_EXTENDED_EN:
668 ri->rinfo->desc.min_uV = 2161000;
669 ri->rinfo->desc.uV_step = 38600;
670 break;
672 return 0;
675 static int tps80031_regulator_probe(struct platform_device *pdev)
677 struct tps80031_platform_data *pdata;
678 struct tps80031_regulator_platform_data *tps_pdata;
679 struct tps80031_regulator *ri;
680 struct tps80031_regulator *pmic;
681 struct regulator_dev *rdev;
682 struct regulator_config config = { };
683 struct tps80031 *tps80031_mfd = dev_get_drvdata(pdev->dev.parent);
684 int ret;
685 int num;
687 pdata = dev_get_platdata(pdev->dev.parent);
689 if (!pdata) {
690 dev_err(&pdev->dev, "No platform data\n");
691 return -EINVAL;
694 pmic = devm_kzalloc(&pdev->dev,
695 TPS80031_REGULATOR_MAX * sizeof(*pmic), GFP_KERNEL);
696 if (!pmic) {
697 dev_err(&pdev->dev, "mem alloc for pmic failed\n");
698 return -ENOMEM;
701 for (num = 0; num < TPS80031_REGULATOR_MAX; ++num) {
702 tps_pdata = pdata->regulator_pdata[num];
703 ri = &pmic[num];
704 ri->rinfo = &tps80031_rinfo[num];
705 ri->dev = &pdev->dev;
707 check_smps_mode_mult(pdev->dev.parent, ri);
708 config.dev = &pdev->dev;
709 config.init_data = NULL;
710 config.driver_data = ri;
711 config.regmap = tps80031_mfd->regmap[ri->rinfo->volt_id];
713 if (tps_pdata) {
714 config.init_data = tps_pdata->reg_init_data;
715 ri->config_flags = tps_pdata->config_flags;
716 ri->ext_ctrl_flag = tps_pdata->ext_ctrl_flag;
717 ret = tps80031_regulator_config(pdev->dev.parent,
718 ri, tps_pdata);
719 if (ret < 0) {
720 dev_err(&pdev->dev,
721 "regulator config failed, e %d\n", ret);
722 goto fail;
725 ret = tps80031_power_req_config(pdev->dev.parent,
726 ri, tps_pdata);
727 if (ret < 0) {
728 dev_err(&pdev->dev,
729 "pwr_req config failed, err %d\n", ret);
730 goto fail;
733 rdev = regulator_register(&ri->rinfo->desc, &config);
734 if (IS_ERR(rdev)) {
735 dev_err(&pdev->dev,
736 "register regulator failed %s\n",
737 ri->rinfo->desc.name);
738 ret = PTR_ERR(rdev);
739 goto fail;
741 ri->rdev = rdev;
744 platform_set_drvdata(pdev, pmic);
745 return 0;
746 fail:
747 while (--num >= 0) {
748 ri = &pmic[num];
749 regulator_unregister(ri->rdev);
751 return ret;
754 static int tps80031_regulator_remove(struct platform_device *pdev)
756 struct tps80031_regulator *pmic = platform_get_drvdata(pdev);
757 struct tps80031_regulator *ri = NULL;
758 int num;
760 for (num = 0; num < TPS80031_REGULATOR_MAX; ++num) {
761 ri = &pmic[num];
762 regulator_unregister(ri->rdev);
764 return 0;
767 static struct platform_driver tps80031_regulator_driver = {
768 .driver = {
769 .name = "tps80031-pmic",
770 .owner = THIS_MODULE,
772 .probe = tps80031_regulator_probe,
773 .remove = tps80031_regulator_remove,
776 static int __init tps80031_regulator_init(void)
778 return platform_driver_register(&tps80031_regulator_driver);
780 subsys_initcall(tps80031_regulator_init);
782 static void __exit tps80031_regulator_exit(void)
784 platform_driver_unregister(&tps80031_regulator_driver);
786 module_exit(tps80031_regulator_exit);
788 MODULE_ALIAS("platform:tps80031-regulator");
789 MODULE_DESCRIPTION("Regulator Driver for TI TPS80031/TPS80032 PMIC");
790 MODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>");
791 MODULE_LICENSE("GPL v2");