Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm-4.9 / c2543b5f6c3e13996776079cda1007ef6e7a0bbb / . / drivers / regulator / palmas-regulator.c
blob: b4e10b0b36d4380eb98b8a8346ba333cf2bc6831 [file] [log] [blame]
Graeme Gregorye5ce4202012-05-18 16:53:57 +0100[diff] [blame]1/*
2 * Driver for Regulator part of Palmas PMIC Chips
3 *
4 * Copyright 2011-2012 Texas Instruments Inc.
5 *
6 * Author: Graeme Gregory <gg@slimlogic.co.uk>
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
12 *
13 */
14
15#include <linux/kernel.h>
16#include <linux/module.h>
17#include <linux/init.h>
18#include <linux/err.h>
19#include <linux/platform_device.h>
20#include <linux/regulator/driver.h>
21#include <linux/regulator/machine.h>
22#include <linux/slab.h>
23#include <linux/regmap.h>
24#include <linux/mfd/palmas.h>
25
26struct regs_info {
27 char *name;
28 u8 vsel_addr;
29 u8 ctrl_addr;
30 u8 tstep_addr;
31};
32
33static const struct regs_info palmas_regs_info[] = {
34 {
35 .name = "SMPS12",
36 .vsel_addr = PALMAS_SMPS12_VOLTAGE,
37 .ctrl_addr = PALMAS_SMPS12_CTRL,
38 .tstep_addr = PALMAS_SMPS12_TSTEP,
39 },
40 {
41 .name = "SMPS123",
42 .vsel_addr = PALMAS_SMPS12_VOLTAGE,
43 .ctrl_addr = PALMAS_SMPS12_CTRL,
44 .tstep_addr = PALMAS_SMPS12_TSTEP,
45 },
46 {
47 .name = "SMPS3",
48 .vsel_addr = PALMAS_SMPS3_VOLTAGE,
49 .ctrl_addr = PALMAS_SMPS3_CTRL,
50 },
51 {
52 .name = "SMPS45",
53 .vsel_addr = PALMAS_SMPS45_VOLTAGE,
54 .ctrl_addr = PALMAS_SMPS45_CTRL,
55 .tstep_addr = PALMAS_SMPS45_TSTEP,
56 },
57 {
58 .name = "SMPS457",
59 .vsel_addr = PALMAS_SMPS45_VOLTAGE,
60 .ctrl_addr = PALMAS_SMPS45_CTRL,
61 .tstep_addr = PALMAS_SMPS45_TSTEP,
62 },
63 {
64 .name = "SMPS6",
65 .vsel_addr = PALMAS_SMPS6_VOLTAGE,
66 .ctrl_addr = PALMAS_SMPS6_CTRL,
67 .tstep_addr = PALMAS_SMPS6_TSTEP,
68 },
69 {
70 .name = "SMPS7",
71 .vsel_addr = PALMAS_SMPS7_VOLTAGE,
72 .ctrl_addr = PALMAS_SMPS7_CTRL,
73 },
74 {
75 .name = "SMPS8",
76 .vsel_addr = PALMAS_SMPS8_VOLTAGE,
77 .ctrl_addr = PALMAS_SMPS8_CTRL,
78 .tstep_addr = PALMAS_SMPS8_TSTEP,
79 },
80 {
81 .name = "SMPS9",
82 .vsel_addr = PALMAS_SMPS9_VOLTAGE,
83 .ctrl_addr = PALMAS_SMPS9_CTRL,
84 },
85 {
86 .name = "SMPS10",
87 },
88 {
89 .name = "LDO1",
90 .vsel_addr = PALMAS_LDO1_VOLTAGE,
91 .ctrl_addr = PALMAS_LDO1_CTRL,
92 },
93 {
94 .name = "LDO2",
95 .vsel_addr = PALMAS_LDO2_VOLTAGE,
96 .ctrl_addr = PALMAS_LDO2_CTRL,
97 },
98 {
99 .name = "LDO3",
100 .vsel_addr = PALMAS_LDO3_VOLTAGE,
101 .ctrl_addr = PALMAS_LDO3_CTRL,
102 },
103 {
104 .name = "LDO4",
105 .vsel_addr = PALMAS_LDO4_VOLTAGE,
106 .ctrl_addr = PALMAS_LDO4_CTRL,
107 },
108 {
109 .name = "LDO5",
110 .vsel_addr = PALMAS_LDO5_VOLTAGE,
111 .ctrl_addr = PALMAS_LDO5_CTRL,
112 },
113 {
114 .name = "LDO6",
115 .vsel_addr = PALMAS_LDO6_VOLTAGE,
116 .ctrl_addr = PALMAS_LDO6_CTRL,
117 },
118 {
119 .name = "LDO7",
120 .vsel_addr = PALMAS_LDO7_VOLTAGE,
121 .ctrl_addr = PALMAS_LDO7_CTRL,
122 },
123 {
124 .name = "LDO8",
125 .vsel_addr = PALMAS_LDO8_VOLTAGE,
126 .ctrl_addr = PALMAS_LDO8_CTRL,
127 },
128 {
129 .name = "LDO9",
130 .vsel_addr = PALMAS_LDO9_VOLTAGE,
131 .ctrl_addr = PALMAS_LDO9_CTRL,
132 },
133 {
134 .name = "LDOLN",
135 .vsel_addr = PALMAS_LDOLN_VOLTAGE,
136 .ctrl_addr = PALMAS_LDOLN_CTRL,
137 },
138 {
139 .name = "LDOUSB",
140 .vsel_addr = PALMAS_LDOUSB_VOLTAGE,
141 .ctrl_addr = PALMAS_LDOUSB_CTRL,
142 },
143};
144
145#define SMPS_CTRL_MODE_OFF 0x00
146#define SMPS_CTRL_MODE_ON 0x01
147#define SMPS_CTRL_MODE_ECO 0x02
148#define SMPS_CTRL_MODE_PWM 0x03
149
150/* These values are derived from the data sheet. And are the number of steps
151 * where there is a voltage change, the ranges at beginning and end of register
152 * max/min values where there are no change are ommitted.
153 *
154 * So they are basically (maxV-minV)/stepV
155 */
156#define PALMAS_SMPS_NUM_VOLTAGES 116
157#define PALMAS_SMPS10_NUM_VOLTAGES 2
158#define PALMAS_LDO_NUM_VOLTAGES 50
159
160#define SMPS10_VSEL (1<<3)
161#define SMPS10_BOOST_EN (1<<2)
162#define SMPS10_BYPASS_EN (1<<1)
163#define SMPS10_SWITCH_EN (1<<0)
164
165#define REGULATOR_SLAVE 0
166
167static int palmas_smps_read(struct palmas *palmas, unsigned int reg,
168 unsigned int *dest)
169{
170 unsigned int addr;
171
172 addr = PALMAS_BASE_TO_REG(PALMAS_SMPS_BASE, reg);
173
174 return regmap_read(palmas->regmap[REGULATOR_SLAVE], addr, dest);
175}
176
177static int palmas_smps_write(struct palmas *palmas, unsigned int reg,
178 unsigned int value)
179{
180 unsigned int addr;
181
182 addr = PALMAS_BASE_TO_REG(PALMAS_SMPS_BASE, reg);
183
184 return regmap_write(palmas->regmap[REGULATOR_SLAVE], addr, value);
185}
186
187static int palmas_ldo_read(struct palmas *palmas, unsigned int reg,
188 unsigned int *dest)
189{
190 unsigned int addr;
191
192 addr = PALMAS_BASE_TO_REG(PALMAS_LDO_BASE, reg);
193
194 return regmap_read(palmas->regmap[REGULATOR_SLAVE], addr, dest);
195}
196
197static int palmas_ldo_write(struct palmas *palmas, unsigned int reg,
198 unsigned int value)
199{
200 unsigned int addr;
201
202 addr = PALMAS_BASE_TO_REG(PALMAS_LDO_BASE, reg);
203
204 return regmap_write(palmas->regmap[REGULATOR_SLAVE], addr, value);
205}
206
207static int palmas_is_enabled_smps(struct regulator_dev *dev)
208{
209 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
210 int id = rdev_get_id(dev);
211 unsigned int reg;
212
213 palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
214
215 reg &= PALMAS_SMPS12_CTRL_STATUS_MASK;
216 reg >>= PALMAS_SMPS12_CTRL_STATUS_SHIFT;
217
218 return !!(reg);
219}
220
221static int palmas_enable_smps(struct regulator_dev *dev)
222{
223 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
224 int id = rdev_get_id(dev);
225 unsigned int reg;
226
227 palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
228
229 reg &= ~PALMAS_SMPS12_CTRL_MODE_ACTIVE_MASK;
230 reg |= SMPS_CTRL_MODE_ON;
231
232 palmas_smps_write(pmic->palmas, palmas_regs_info[id].ctrl_addr, reg);
233
234 return 0;
235}
236
237static int palmas_disable_smps(struct regulator_dev *dev)
238{
239 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
240 int id = rdev_get_id(dev);
241 unsigned int reg;
242
243 palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
244
245 reg &= ~PALMAS_SMPS12_CTRL_MODE_ACTIVE_MASK;
246
247 palmas_smps_write(pmic->palmas, palmas_regs_info[id].ctrl_addr, reg);
248
249 return 0;
250}
251
252
253static int palmas_set_mode_smps(struct regulator_dev *dev, unsigned int mode)
254{
255 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
256 int id = rdev_get_id(dev);
257 unsigned int reg;
258
259 palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
260 reg &= ~PALMAS_SMPS12_CTRL_STATUS_MASK;
261 reg >>= PALMAS_SMPS12_CTRL_STATUS_SHIFT;
262
263 switch (mode) {
264 case REGULATOR_MODE_NORMAL:
265 reg |= SMPS_CTRL_MODE_ON;
266 break;
267 case REGULATOR_MODE_IDLE:
268 reg |= SMPS_CTRL_MODE_ECO;
269 break;
270 case REGULATOR_MODE_FAST:
271 reg |= SMPS_CTRL_MODE_PWM;
272 break;
273 default:
274 return -EINVAL;
275 }
276 palmas_smps_write(pmic->palmas, palmas_regs_info[id].ctrl_addr, reg);
277
278 return 0;
279}
280
281static unsigned int palmas_get_mode_smps(struct regulator_dev *dev)
282{
283 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
284 int id = rdev_get_id(dev);
285 unsigned int reg;
286
287 palmas_smps_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
288 reg &= PALMAS_SMPS12_CTRL_STATUS_MASK;
289 reg >>= PALMAS_SMPS12_CTRL_STATUS_SHIFT;
290
291 switch (reg) {
292 case SMPS_CTRL_MODE_ON:
293 return REGULATOR_MODE_NORMAL;
294 case SMPS_CTRL_MODE_ECO:
295 return REGULATOR_MODE_IDLE;
296 case SMPS_CTRL_MODE_PWM:
297 return REGULATOR_MODE_FAST;
298 }
299
300 return 0;
301}
302
303static int palmas_list_voltage_smps(struct regulator_dev *dev,
304 unsigned selector)
305{
306 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
307 int id = rdev_get_id(dev);
308 int mult = 1;
309
310 if (!selector)
311 return 0;
312
313 /* Read the multiplier set in VSEL register to return
314 * the correct voltage.
315 */
316 if (pmic->range[id])
317 mult = 2;
318
319 /* Voltage is (0.49V + (selector * 0.01V)) * RANGE
320 * as defined in data sheet. RANGE is either x1 or x2
321 */
322 return (490000 + (selector * 10000)) * mult;
323}
324
325static int palmas_get_voltage_smps_sel(struct regulator_dev *dev)
326{
327 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
328 int id = rdev_get_id(dev);
329 int selector;
330 unsigned int reg;
331 unsigned int addr;
332
333 addr = palmas_regs_info[id].vsel_addr;
334
335 palmas_smps_read(pmic->palmas, addr, &reg);
336
337 selector = reg & PALMAS_SMPS12_VOLTAGE_VSEL_MASK;
338
339 /* Adjust selector to match list_voltage ranges */
340 if ((selector > 0) && (selector < 6))
341 selector = 6;
342 if (!selector)
343 selector = 5;
344 if (selector > 121)
345 selector = 121;
346 selector -= 5;
347
348 return selector;
349}
350
351static int palmas_set_voltage_smps_sel(struct regulator_dev *dev,
352 unsigned selector)
353{
354 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
355 int id = rdev_get_id(dev);
356 unsigned int reg = 0;
357 unsigned int addr;
358
359 addr = palmas_regs_info[id].vsel_addr;
360
361 /* Make sure we don't change the value of RANGE */
362 if (pmic->range[id])
363 reg |= PALMAS_SMPS12_VOLTAGE_RANGE;
364
365 /* Adjust the linux selector into range used in VSEL register */
366 if (selector)
367 reg |= selector + 5;
368
369 palmas_smps_write(pmic->palmas, addr, reg);
370
371 return 0;
372}
373
374static int palmas_map_voltage_smps(struct regulator_dev *rdev,
375 int min_uV, int max_uV)
376{
377 int ret, voltage;
378
379 ret = ((min_uV - 500000) / 10000) + 1;
380 if (ret < 0)
381 return ret;
382
383 /* Map back into a voltage to verify we're still in bounds */
384 voltage = palmas_list_voltage_smps(rdev, ret);
385 if (voltage < min_uV || voltage > max_uV)
386 return -EINVAL;
387
388 return ret;
389}
390
391static struct regulator_ops palmas_ops_smps = {
392 .is_enabled = palmas_is_enabled_smps,
393 .enable = palmas_enable_smps,
394 .disable = palmas_disable_smps,
395 .set_mode = palmas_set_mode_smps,
396 .get_mode = palmas_get_mode_smps,
397 .get_voltage_sel = palmas_get_voltage_smps_sel,
398 .set_voltage_sel = palmas_set_voltage_smps_sel,
399 .list_voltage = palmas_list_voltage_smps,
400 .map_voltage = palmas_map_voltage_smps,
401};
402
Graeme Gregorye5ce4202012-05-18 16:53:57 +0100[diff] [blame]403static struct regulator_ops palmas_ops_smps10 = {
404 .is_enabled = regulator_is_enabled_regmap,
405 .enable = regulator_enable_regmap,
406 .disable = regulator_disable_regmap,
407 .get_voltage_sel = regulator_get_voltage_sel_regmap,
408 .set_voltage_sel = regulator_set_voltage_sel_regmap,
Axel Lin8029a002012-05-22 12:26:42 +0800[diff] [blame]409 .list_voltage = regulator_list_voltage_linear,
410 .map_voltage = regulator_map_voltage_linear,
Graeme Gregorye5ce4202012-05-18 16:53:57 +0100[diff] [blame]411};
412
413static int palmas_is_enabled_ldo(struct regulator_dev *dev)
414{
415 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
416 int id = rdev_get_id(dev);
417 unsigned int reg;
418
419 palmas_ldo_read(pmic->palmas, palmas_regs_info[id].ctrl_addr, &reg);
420
421 reg &= PALMAS_LDO1_CTRL_STATUS;
422
423 return !!(reg);
424}
425
426static int palmas_list_voltage_ldo(struct regulator_dev *dev,
427 unsigned selector)
428{
429 if (!selector)
430 return 0;
431
432 /* voltage is 0.85V + (selector * 0.05v) */
433 return 850000 + (selector * 50000);
434}
435
436static int palmas_get_voltage_ldo_sel(struct regulator_dev *dev)
437{
438 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
439 int id = rdev_get_id(dev);
440 int selector;
441 unsigned int reg;
442 unsigned int addr;
443
444 addr = palmas_regs_info[id].vsel_addr;
445
446 palmas_ldo_read(pmic->palmas, addr, &reg);
447
448 selector = reg & PALMAS_LDO1_VOLTAGE_VSEL_MASK;
449
450 /* Adjust selector to match list_voltage ranges */
451 if (selector > 49)
452 selector = 49;
453
454 return selector;
455}
456
457static int palmas_set_voltage_ldo_sel(struct regulator_dev *dev,
458 unsigned selector)
459{
460 struct palmas_pmic *pmic = rdev_get_drvdata(dev);
461 int id = rdev_get_id(dev);
462 unsigned int reg = 0;
463 unsigned int addr;
464
465 addr = palmas_regs_info[id].vsel_addr;
466
467 reg = selector;
468
469 palmas_ldo_write(pmic->palmas, addr, reg);
470
471 return 0;
472}
473
474static int palmas_map_voltage_ldo(struct regulator_dev *rdev,
475 int min_uV, int max_uV)
476{
477 int ret, voltage;
478
479 ret = ((min_uV - 900000) / 50000) + 1;
480 if (ret < 0)
481 return ret;
482
483 /* Map back into a voltage to verify we're still in bounds */
484 voltage = palmas_list_voltage_ldo(rdev, ret);
485 if (voltage < min_uV || voltage > max_uV)
486 return -EINVAL;
487
488 return ret;
489}
490
491static struct regulator_ops palmas_ops_ldo = {
492 .is_enabled = palmas_is_enabled_ldo,
493 .enable = regulator_enable_regmap,
494 .disable = regulator_disable_regmap,
495 .get_voltage_sel = palmas_get_voltage_ldo_sel,
496 .set_voltage_sel = palmas_set_voltage_ldo_sel,
497 .list_voltage = palmas_list_voltage_ldo,
498 .map_voltage = palmas_map_voltage_ldo,
499};
500
501/*
502 * setup the hardware based sleep configuration of the SMPS/LDO regulators
503 * from the platform data. This is different to the software based control
504 * supported by the regulator framework as it is controlled by toggling
505 * pins on the PMIC such as PREQ, SYSEN, ...
506 */
507static int palmas_smps_init(struct palmas *palmas, int id,
508 struct palmas_reg_init *reg_init)
509{
510 unsigned int reg;
511 unsigned int addr;
512 int ret;
513
514 addr = palmas_regs_info[id].ctrl_addr;
515
516 ret = palmas_smps_read(palmas, addr, &reg);
517 if (ret)
518 return ret;
519
520 if (id != PALMAS_REG_SMPS10) {
521 if (reg_init->warm_reset)
522 reg |= PALMAS_SMPS12_CTRL_WR_S;
523
524 if (reg_init->roof_floor)
525 reg |= PALMAS_SMPS12_CTRL_ROOF_FLOOR_EN;
526
527 if (reg_init->mode_sleep) {
528 reg &= ~PALMAS_SMPS12_CTRL_MODE_SLEEP_MASK;
529 reg |= reg_init->mode_sleep <<
530 PALMAS_SMPS12_CTRL_MODE_SLEEP_SHIFT;
531 }
532 } else {
533 if (reg_init->mode_sleep) {
534 reg &= ~PALMAS_SMPS10_CTRL_MODE_SLEEP_MASK;
535 reg |= reg_init->mode_sleep <<
536 PALMAS_SMPS10_CTRL_MODE_SLEEP_SHIFT;
537 }
538
539 }
540 ret = palmas_smps_write(palmas, addr, reg);
541 if (ret)
542 return ret;
543
544 if (palmas_regs_info[id].tstep_addr && reg_init->tstep) {
545 addr = palmas_regs_info[id].tstep_addr;
546
547 reg = reg_init->tstep & PALMAS_SMPS12_TSTEP_TSTEP_MASK;
548
549 ret = palmas_smps_write(palmas, addr, reg);
550 if (ret)
551 return ret;
552 }
553
554 if (palmas_regs_info[id].vsel_addr && reg_init->vsel) {
555 addr = palmas_regs_info[id].vsel_addr;
556
557 reg = reg_init->vsel;
558
559 ret = palmas_smps_write(palmas, addr, reg);
560 if (ret)
561 return ret;
562 }
563
564
565 return 0;
566}
567
568static int palmas_ldo_init(struct palmas *palmas, int id,
569 struct palmas_reg_init *reg_init)
570{
571 unsigned int reg;
572 unsigned int addr;
573 int ret;
574
575 addr = palmas_regs_info[id].ctrl_addr;
576
577 ret = palmas_smps_read(palmas, addr, &reg);
578 if (ret)
579 return ret;
580
581 if (reg_init->warm_reset)
582 reg |= PALMAS_LDO1_CTRL_WR_S;
583
584 if (reg_init->mode_sleep)
585 reg |= PALMAS_LDO1_CTRL_MODE_SLEEP;
586
587 ret = palmas_smps_write(palmas, addr, reg);
588 if (ret)
589 return ret;
590
591 return 0;
592}
593
594static __devinit int palmas_probe(struct platform_device *pdev)
595{
596 struct palmas *palmas = dev_get_drvdata(pdev->dev.parent);
597 struct palmas_pmic_platform_data *pdata = pdev->dev.platform_data;
598 struct regulator_dev *rdev;
599 struct regulator_config config = { };
600 struct palmas_pmic *pmic;
601 struct palmas_reg_init *reg_init;
602 int id = 0, ret;
603 unsigned int addr, reg;
604
605 if (!pdata)
606 return -EINVAL;
607 if (!pdata->reg_data)
608 return -EINVAL;
609
610 pmic = devm_kzalloc(&pdev->dev, sizeof(*pmic), GFP_KERNEL);
611 if (!pmic)
612 return -ENOMEM;
613
614 pmic->dev = &pdev->dev;
615 pmic->palmas = palmas;
616 palmas->pmic = pmic;
617 platform_set_drvdata(pdev, pmic);
618
619 ret = palmas_smps_read(palmas, PALMAS_SMPS_CTRL, &reg);
620 if (ret)
621 goto err_unregister_regulator;
622
623 if (reg & PALMAS_SMPS_CTRL_SMPS12_SMPS123_EN)
624 pmic->smps123 = 1;
625
626 if (reg & PALMAS_SMPS_CTRL_SMPS45_SMPS457_EN)
627 pmic->smps457 = 1;
628
629 config.regmap = palmas->regmap[REGULATOR_SLAVE];
630 config.dev = &pdev->dev;
631 config.driver_data = pmic;
632
633 for (id = 0; id < PALMAS_REG_LDO1; id++) {
634
635 /*
636 * Miss out regulators which are not available due
637 * to slaving configurations.
638 */
639 switch (id) {
640 case PALMAS_REG_SMPS12:
641 case PALMAS_REG_SMPS3:
642 if (pmic->smps123)
643 continue;
644 break;
645 case PALMAS_REG_SMPS123:
646 if (!pmic->smps123)
647 continue;
648 break;
649 case PALMAS_REG_SMPS45:
650 case PALMAS_REG_SMPS7:
651 if (pmic->smps457)
652 continue;
653 break;
654 case PALMAS_REG_SMPS457:
655 if (!pmic->smps457)
656 continue;
657 }
658
659 /* Register the regulators */
660 pmic->desc[id].name = palmas_regs_info[id].name;
661 pmic->desc[id].id = id;
662
663 if (id != PALMAS_REG_SMPS10) {
664 pmic->desc[id].ops = &palmas_ops_smps;
665 pmic->desc[id].n_voltages = PALMAS_SMPS_NUM_VOLTAGES;
666 } else {
667 pmic->desc[id].n_voltages = PALMAS_SMPS10_NUM_VOLTAGES;
668 pmic->desc[id].ops = &palmas_ops_smps10;
669 pmic->desc[id].vsel_reg = PALMAS_SMPS10_CTRL;
670 pmic->desc[id].vsel_mask = SMPS10_VSEL;
671 pmic->desc[id].enable_reg = PALMAS_SMPS10_STATUS;
672 pmic->desc[id].enable_mask = SMPS10_BOOST_EN;
Axel Lin8029a002012-05-22 12:26:42 +0800[diff] [blame]673 pmic->desc[id].min_uV = 3750000;
674 pmic->desc[id].uV_step = 1250000;
Graeme Gregorye5ce4202012-05-18 16:53:57 +0100[diff] [blame]675 }
676
677 pmic->desc[id].type = REGULATOR_VOLTAGE;
678 pmic->desc[id].owner = THIS_MODULE;
679
680 /* Initialise sleep/init values from platform data */
681 if (pdata && pdata->reg_init) {
682 reg_init = pdata->reg_init[id];
683 if (reg_init) {
684 ret = palmas_smps_init(palmas, id, reg_init);
685 if (ret)
686 goto err_unregister_regulator;
687 }
688 }
689
690 /*
691 * read and store the RANGE bit for later use
692 * This must be done before regulator is probed otherwise
693 * we error in probe with unsuportable ranges.
694 */
695 if (id != PALMAS_REG_SMPS10) {
696 addr = palmas_regs_info[id].vsel_addr;
697
698 ret = palmas_smps_read(pmic->palmas, addr, &reg);
699 if (ret)
700 goto err_unregister_regulator;
701 if (reg & PALMAS_SMPS12_VOLTAGE_RANGE)
702 pmic->range[id] = 1;
703 }
704
705 if (pdata && pdata->reg_data)
706 config.init_data = pdata->reg_data[id];
707 else
708 config.init_data = NULL;
709
710 rdev = regulator_register(&pmic->desc[id], &config);
711 if (IS_ERR(rdev)) {
712 dev_err(&pdev->dev,
713 "failed to register %s regulator\n",
714 pdev->name);
715 ret = PTR_ERR(rdev);
716 goto err_unregister_regulator;
717 }
718
719 /* Save regulator for cleanup */
720 pmic->rdev[id] = rdev;
721 }
722
723 /* Start this loop from the id left from previous loop */
724 for (; id < PALMAS_NUM_REGS; id++) {
725
726 /* Miss out regulators which are not available due
727 * to alternate functions.
728 */
729
730 /* Register the regulators */
731 pmic->desc[id].name = palmas_regs_info[id].name;
732 pmic->desc[id].id = id;
733 pmic->desc[id].n_voltages = PALMAS_LDO_NUM_VOLTAGES;
734
735 pmic->desc[id].ops = &palmas_ops_ldo;
736
737 pmic->desc[id].type = REGULATOR_VOLTAGE;
738 pmic->desc[id].owner = THIS_MODULE;
739 pmic->desc[id].enable_reg = palmas_regs_info[id].ctrl_addr;
740 pmic->desc[id].enable_mask = PALMAS_LDO1_CTRL_MODE_ACTIVE;
741
742 if (pdata && pdata->reg_data)
743 config.init_data = pdata->reg_data[id];
744 else
745 config.init_data = NULL;
746
747 rdev = regulator_register(&pmic->desc[id], &config);
748 if (IS_ERR(rdev)) {
749 dev_err(&pdev->dev,
750 "failed to register %s regulator\n",
751 pdev->name);
752 ret = PTR_ERR(rdev);
753 goto err_unregister_regulator;
754 }
755
756 /* Save regulator for cleanup */
757 pmic->rdev[id] = rdev;
758
759 /* Initialise sleep/init values from platform data */
760 if (pdata->reg_init) {
761 reg_init = pdata->reg_init[id];
762 if (reg_init) {
763 ret = palmas_ldo_init(palmas, id, reg_init);
764 if (ret)
765 goto err_unregister_regulator;
766 }
767 }
768 }
769
770 return 0;
771
772err_unregister_regulator:
773 while (--id >= 0)
774 regulator_unregister(pmic->rdev[id]);
775 kfree(pmic->rdev);
776 kfree(pmic->desc);
777 kfree(pmic);
778 return ret;
779}
780
781static int __devexit palmas_remove(struct platform_device *pdev)
782{
783 struct palmas_pmic *pmic = platform_get_drvdata(pdev);
784 int id;
785
786 for (id = 0; id < PALMAS_NUM_REGS; id++)
787 regulator_unregister(pmic->rdev[id]);
788
789 kfree(pmic->rdev);
790 kfree(pmic->desc);
791 kfree(pmic);
792 return 0;
793}
794
795static struct platform_driver palmas_driver = {
796 .driver = {
797 .name = "palmas-pmic",
798 .owner = THIS_MODULE,
799 },
800 .probe = palmas_probe,
801 .remove = __devexit_p(palmas_remove),
802};
803
804static int __init palmas_init(void)
805{
806 return platform_driver_register(&palmas_driver);
807}
808subsys_initcall(palmas_init);
809
810static void __exit palmas_exit(void)
811{
812 platform_driver_unregister(&palmas_driver);
813}
814module_exit(palmas_exit);
815
816MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>");
817MODULE_DESCRIPTION("Palmas voltage regulator driver");
818MODULE_LICENSE("GPL");
819MODULE_ALIAS("platform:palmas-pmic");