4 * Copyright (c) 2011 Samsung Electronics Co., Ltd
5 * http://www.samsung.com
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
14 #include <linux/bug.h>
15 #include <linux/err.h>
16 #include <linux/gpio.h>
17 #include <linux/slab.h>
18 #include <linux/module.h>
19 #include <linux/platform_device.h>
20 #include <linux/regulator/driver.h>
21 #include <linux/regulator/machine.h>
22 #include <linux/mfd/samsung/core.h>
23 #include <linux/mfd/samsung/s5m8767.h>
27 struct sec_pmic_dev
*iodev
;
29 struct regulator_dev
**rdev
;
30 struct sec_opmode_data
*opmode
;
48 struct sec_voltage_desc
{
54 static const struct sec_voltage_desc buck_voltage_val1
= {
60 static const struct sec_voltage_desc buck_voltage_val2
= {
66 static const struct sec_voltage_desc buck_voltage_val3
= {
72 static const struct sec_voltage_desc ldo_voltage_val1
= {
78 static const struct sec_voltage_desc ldo_voltage_val2
= {
84 static const struct sec_voltage_desc
*reg_voltage_map
[] = {
85 [S5M8767_LDO1
] = &ldo_voltage_val2
,
86 [S5M8767_LDO2
] = &ldo_voltage_val2
,
87 [S5M8767_LDO3
] = &ldo_voltage_val1
,
88 [S5M8767_LDO4
] = &ldo_voltage_val1
,
89 [S5M8767_LDO5
] = &ldo_voltage_val1
,
90 [S5M8767_LDO6
] = &ldo_voltage_val2
,
91 [S5M8767_LDO7
] = &ldo_voltage_val2
,
92 [S5M8767_LDO8
] = &ldo_voltage_val2
,
93 [S5M8767_LDO9
] = &ldo_voltage_val1
,
94 [S5M8767_LDO10
] = &ldo_voltage_val1
,
95 [S5M8767_LDO11
] = &ldo_voltage_val1
,
96 [S5M8767_LDO12
] = &ldo_voltage_val1
,
97 [S5M8767_LDO13
] = &ldo_voltage_val1
,
98 [S5M8767_LDO14
] = &ldo_voltage_val1
,
99 [S5M8767_LDO15
] = &ldo_voltage_val2
,
100 [S5M8767_LDO16
] = &ldo_voltage_val1
,
101 [S5M8767_LDO17
] = &ldo_voltage_val1
,
102 [S5M8767_LDO18
] = &ldo_voltage_val1
,
103 [S5M8767_LDO19
] = &ldo_voltage_val1
,
104 [S5M8767_LDO20
] = &ldo_voltage_val1
,
105 [S5M8767_LDO21
] = &ldo_voltage_val1
,
106 [S5M8767_LDO22
] = &ldo_voltage_val1
,
107 [S5M8767_LDO23
] = &ldo_voltage_val1
,
108 [S5M8767_LDO24
] = &ldo_voltage_val1
,
109 [S5M8767_LDO25
] = &ldo_voltage_val1
,
110 [S5M8767_LDO26
] = &ldo_voltage_val1
,
111 [S5M8767_LDO27
] = &ldo_voltage_val1
,
112 [S5M8767_LDO28
] = &ldo_voltage_val1
,
113 [S5M8767_BUCK1
] = &buck_voltage_val1
,
114 [S5M8767_BUCK2
] = &buck_voltage_val2
,
115 [S5M8767_BUCK3
] = &buck_voltage_val2
,
116 [S5M8767_BUCK4
] = &buck_voltage_val2
,
117 [S5M8767_BUCK5
] = &buck_voltage_val1
,
118 [S5M8767_BUCK6
] = &buck_voltage_val1
,
119 [S5M8767_BUCK7
] = NULL
,
120 [S5M8767_BUCK8
] = NULL
,
121 [S5M8767_BUCK9
] = &buck_voltage_val3
,
124 static unsigned int s5m8767_opmode_reg
[][4] = {
125 /* {OFF, ON, LOWPOWER, SUSPEND} */
127 {0x0, 0x3, 0x2, 0x1}, /* LDO1 */
128 {0x0, 0x3, 0x2, 0x1},
129 {0x0, 0x3, 0x2, 0x1},
130 {0x0, 0x0, 0x0, 0x0},
131 {0x0, 0x3, 0x2, 0x1}, /* LDO5 */
132 {0x0, 0x3, 0x2, 0x1},
133 {0x0, 0x3, 0x2, 0x1},
134 {0x0, 0x3, 0x2, 0x1},
135 {0x0, 0x3, 0x2, 0x1},
136 {0x0, 0x3, 0x2, 0x1}, /* LDO10 */
137 {0x0, 0x3, 0x2, 0x1},
138 {0x0, 0x3, 0x2, 0x1},
139 {0x0, 0x3, 0x2, 0x1},
140 {0x0, 0x3, 0x2, 0x1},
141 {0x0, 0x3, 0x2, 0x1}, /* LDO15 */
142 {0x0, 0x3, 0x2, 0x1},
143 {0x0, 0x3, 0x2, 0x1},
144 {0x0, 0x0, 0x0, 0x0},
145 {0x0, 0x3, 0x2, 0x1},
146 {0x0, 0x3, 0x2, 0x1}, /* LDO20 */
147 {0x0, 0x3, 0x2, 0x1},
148 {0x0, 0x3, 0x2, 0x1},
149 {0x0, 0x0, 0x0, 0x0},
150 {0x0, 0x3, 0x2, 0x1},
151 {0x0, 0x3, 0x2, 0x1}, /* LDO25 */
152 {0x0, 0x3, 0x2, 0x1},
153 {0x0, 0x3, 0x2, 0x1},
154 {0x0, 0x3, 0x2, 0x1}, /* LDO28 */
156 /* BUCK1 ... BUCK9 */
157 {0x0, 0x3, 0x1, 0x1}, /* BUCK1 */
158 {0x0, 0x3, 0x1, 0x1},
159 {0x0, 0x3, 0x1, 0x1},
160 {0x0, 0x3, 0x1, 0x1},
161 {0x0, 0x3, 0x2, 0x1}, /* BUCK5 */
162 {0x0, 0x3, 0x1, 0x1},
163 {0x0, 0x3, 0x1, 0x1},
164 {0x0, 0x3, 0x1, 0x1},
165 {0x0, 0x3, 0x1, 0x1}, /* BUCK9 */
168 static int s5m8767_get_register(struct regulator_dev
*rdev
, int *reg
,
171 int reg_id
= rdev_get_id(rdev
);
173 struct s5m8767_info
*s5m8767
= rdev_get_drvdata(rdev
);
176 case S5M8767_LDO1
... S5M8767_LDO2
:
177 *reg
= S5M8767_REG_LDO1CTRL
+ (reg_id
- S5M8767_LDO1
);
179 case S5M8767_LDO3
... S5M8767_LDO28
:
180 *reg
= S5M8767_REG_LDO3CTRL
+ (reg_id
- S5M8767_LDO3
);
183 *reg
= S5M8767_REG_BUCK1CTRL1
;
185 case S5M8767_BUCK2
... S5M8767_BUCK4
:
186 *reg
= S5M8767_REG_BUCK2CTRL
+ (reg_id
- S5M8767_BUCK2
) * 9;
189 *reg
= S5M8767_REG_BUCK5CTRL1
;
191 case S5M8767_BUCK6
... S5M8767_BUCK9
:
192 *reg
= S5M8767_REG_BUCK6CTRL1
+ (reg_id
- S5M8767_BUCK6
) * 2;
198 mode
= s5m8767
->opmode
[reg_id
].mode
;
199 *enable_ctrl
= s5m8767_opmode_reg
[reg_id
][mode
] << S5M8767_ENCTRL_SHIFT
;
203 static int s5m8767_reg_is_enabled(struct regulator_dev
*rdev
)
205 struct s5m8767_info
*s5m8767
= rdev_get_drvdata(rdev
);
207 int mask
= 0xc0, enable_ctrl
;
210 ret
= s5m8767_get_register(rdev
, ®
, &enable_ctrl
);
216 ret
= sec_reg_read(s5m8767
->iodev
, reg
, &val
);
220 return (val
& mask
) == enable_ctrl
;
223 static int s5m8767_reg_enable(struct regulator_dev
*rdev
)
225 struct s5m8767_info
*s5m8767
= rdev_get_drvdata(rdev
);
227 int mask
= 0xc0, enable_ctrl
;
229 ret
= s5m8767_get_register(rdev
, ®
, &enable_ctrl
);
233 return sec_reg_update(s5m8767
->iodev
, reg
, enable_ctrl
, mask
);
236 static int s5m8767_reg_disable(struct regulator_dev
*rdev
)
238 struct s5m8767_info
*s5m8767
= rdev_get_drvdata(rdev
);
240 int mask
= 0xc0, enable_ctrl
;
242 ret
= s5m8767_get_register(rdev
, ®
, &enable_ctrl
);
246 return sec_reg_update(s5m8767
->iodev
, reg
, ~mask
, mask
);
249 static int s5m8767_get_voltage_register(struct regulator_dev
*rdev
, int *_reg
)
251 struct s5m8767_info
*s5m8767
= rdev_get_drvdata(rdev
);
252 int reg_id
= rdev_get_id(rdev
);
256 case S5M8767_LDO1
... S5M8767_LDO2
:
257 reg
= S5M8767_REG_LDO1CTRL
+ (reg_id
- S5M8767_LDO1
);
259 case S5M8767_LDO3
... S5M8767_LDO28
:
260 reg
= S5M8767_REG_LDO3CTRL
+ (reg_id
- S5M8767_LDO3
);
263 reg
= S5M8767_REG_BUCK1CTRL2
;
266 reg
= S5M8767_REG_BUCK2DVS2
;
267 if (s5m8767
->buck2_gpiodvs
)
268 reg
+= s5m8767
->buck_gpioindex
;
271 reg
= S5M8767_REG_BUCK3DVS2
;
272 if (s5m8767
->buck3_gpiodvs
)
273 reg
+= s5m8767
->buck_gpioindex
;
276 reg
= S5M8767_REG_BUCK4DVS2
;
277 if (s5m8767
->buck4_gpiodvs
)
278 reg
+= s5m8767
->buck_gpioindex
;
281 reg
= S5M8767_REG_BUCK5CTRL2
;
283 case S5M8767_BUCK6
... S5M8767_BUCK9
:
284 reg
= S5M8767_REG_BUCK6CTRL2
+ (reg_id
- S5M8767_BUCK6
) * 2;
295 static int s5m8767_get_voltage_sel(struct regulator_dev
*rdev
)
297 struct s5m8767_info
*s5m8767
= rdev_get_drvdata(rdev
);
299 int reg_id
= rdev_get_id(rdev
);
302 ret
= s5m8767_get_voltage_register(rdev
, ®
);
306 mask
= (reg_id
< S5M8767_BUCK1
) ? 0x3f : 0xff;
308 ret
= sec_reg_read(s5m8767
->iodev
, reg
, &val
);
317 static int s5m8767_convert_voltage_to_sel(
318 const struct sec_voltage_desc
*desc
,
319 int min_vol
, int max_vol
)
326 if (max_vol
< desc
->min
|| min_vol
> desc
->max
)
329 if (min_vol
< desc
->min
)
332 selector
= DIV_ROUND_UP(min_vol
- desc
->min
, desc
->step
);
334 if (desc
->min
+ desc
->step
* selector
> max_vol
)
340 static inline int s5m8767_set_high(struct s5m8767_info
*s5m8767
)
342 int temp_index
= s5m8767
->buck_gpioindex
;
344 gpio_set_value(s5m8767
->buck_gpios
[0], (temp_index
>> 2) & 0x1);
345 gpio_set_value(s5m8767
->buck_gpios
[1], (temp_index
>> 1) & 0x1);
346 gpio_set_value(s5m8767
->buck_gpios
[2], temp_index
& 0x1);
351 static inline int s5m8767_set_low(struct s5m8767_info
*s5m8767
)
353 int temp_index
= s5m8767
->buck_gpioindex
;
355 gpio_set_value(s5m8767
->buck_gpios
[2], temp_index
& 0x1);
356 gpio_set_value(s5m8767
->buck_gpios
[1], (temp_index
>> 1) & 0x1);
357 gpio_set_value(s5m8767
->buck_gpios
[0], (temp_index
>> 2) & 0x1);
362 static int s5m8767_set_voltage_sel(struct regulator_dev
*rdev
,
365 struct s5m8767_info
*s5m8767
= rdev_get_drvdata(rdev
);
366 int reg_id
= rdev_get_id(rdev
);
367 int reg
, mask
, ret
= 0, old_index
, index
= 0;
368 u8
*buck234_vol
= NULL
;
371 case S5M8767_LDO1
... S5M8767_LDO28
:
374 case S5M8767_BUCK1
... S5M8767_BUCK6
:
376 if (reg_id
== S5M8767_BUCK2
&& s5m8767
->buck2_gpiodvs
)
377 buck234_vol
= &s5m8767
->buck2_vol
[0];
378 else if (reg_id
== S5M8767_BUCK3
&& s5m8767
->buck3_gpiodvs
)
379 buck234_vol
= &s5m8767
->buck3_vol
[0];
380 else if (reg_id
== S5M8767_BUCK4
&& s5m8767
->buck4_gpiodvs
)
381 buck234_vol
= &s5m8767
->buck4_vol
[0];
383 case S5M8767_BUCK7
... S5M8767_BUCK8
:
392 /* buck234_vol != NULL means to control buck234 voltage via DVS GPIO */
394 while (*buck234_vol
!= selector
) {
398 old_index
= s5m8767
->buck_gpioindex
;
399 s5m8767
->buck_gpioindex
= index
;
401 if (index
> old_index
)
402 return s5m8767_set_high(s5m8767
);
404 return s5m8767_set_low(s5m8767
);
406 ret
= s5m8767_get_voltage_register(rdev
, ®
);
410 return sec_reg_update(s5m8767
->iodev
, reg
, selector
, mask
);
414 static int s5m8767_set_voltage_time_sel(struct regulator_dev
*rdev
,
415 unsigned int old_sel
,
416 unsigned int new_sel
)
418 struct s5m8767_info
*s5m8767
= rdev_get_drvdata(rdev
);
419 const struct sec_voltage_desc
*desc
;
420 int reg_id
= rdev_get_id(rdev
);
422 desc
= reg_voltage_map
[reg_id
];
424 if ((old_sel
< new_sel
) && s5m8767
->ramp_delay
)
425 return DIV_ROUND_UP(desc
->step
* (new_sel
- old_sel
),
426 s5m8767
->ramp_delay
* 1000);
430 static struct regulator_ops s5m8767_ops
= {
431 .list_voltage
= regulator_list_voltage_linear
,
432 .is_enabled
= s5m8767_reg_is_enabled
,
433 .enable
= s5m8767_reg_enable
,
434 .disable
= s5m8767_reg_disable
,
435 .get_voltage_sel
= s5m8767_get_voltage_sel
,
436 .set_voltage_sel
= s5m8767_set_voltage_sel
,
437 .set_voltage_time_sel
= s5m8767_set_voltage_time_sel
,
440 static struct regulator_ops s5m8767_buck78_ops
= {
441 .is_enabled
= s5m8767_reg_is_enabled
,
442 .enable
= s5m8767_reg_enable
,
443 .disable
= s5m8767_reg_disable
,
446 #define s5m8767_regulator_desc(_name) { \
448 .id = S5M8767_##_name, \
449 .ops = &s5m8767_ops, \
450 .type = REGULATOR_VOLTAGE, \
451 .owner = THIS_MODULE, \
454 #define s5m8767_regulator_buck78_desc(_name) { \
456 .id = S5M8767_##_name, \
457 .ops = &s5m8767_buck78_ops, \
458 .type = REGULATOR_VOLTAGE, \
459 .owner = THIS_MODULE, \
462 static struct regulator_desc regulators
[] = {
463 s5m8767_regulator_desc(LDO1
),
464 s5m8767_regulator_desc(LDO2
),
465 s5m8767_regulator_desc(LDO3
),
466 s5m8767_regulator_desc(LDO4
),
467 s5m8767_regulator_desc(LDO5
),
468 s5m8767_regulator_desc(LDO6
),
469 s5m8767_regulator_desc(LDO7
),
470 s5m8767_regulator_desc(LDO8
),
471 s5m8767_regulator_desc(LDO9
),
472 s5m8767_regulator_desc(LDO10
),
473 s5m8767_regulator_desc(LDO11
),
474 s5m8767_regulator_desc(LDO12
),
475 s5m8767_regulator_desc(LDO13
),
476 s5m8767_regulator_desc(LDO14
),
477 s5m8767_regulator_desc(LDO15
),
478 s5m8767_regulator_desc(LDO16
),
479 s5m8767_regulator_desc(LDO17
),
480 s5m8767_regulator_desc(LDO18
),
481 s5m8767_regulator_desc(LDO19
),
482 s5m8767_regulator_desc(LDO20
),
483 s5m8767_regulator_desc(LDO21
),
484 s5m8767_regulator_desc(LDO22
),
485 s5m8767_regulator_desc(LDO23
),
486 s5m8767_regulator_desc(LDO24
),
487 s5m8767_regulator_desc(LDO25
),
488 s5m8767_regulator_desc(LDO26
),
489 s5m8767_regulator_desc(LDO27
),
490 s5m8767_regulator_desc(LDO28
),
491 s5m8767_regulator_desc(BUCK1
),
492 s5m8767_regulator_desc(BUCK2
),
493 s5m8767_regulator_desc(BUCK3
),
494 s5m8767_regulator_desc(BUCK4
),
495 s5m8767_regulator_desc(BUCK5
),
496 s5m8767_regulator_desc(BUCK6
),
497 s5m8767_regulator_buck78_desc(BUCK7
),
498 s5m8767_regulator_buck78_desc(BUCK8
),
499 s5m8767_regulator_desc(BUCK9
),
502 static __devinit
int s5m8767_pmic_probe(struct platform_device
*pdev
)
504 struct sec_pmic_dev
*iodev
= dev_get_drvdata(pdev
->dev
.parent
);
505 struct sec_platform_data
*pdata
= dev_get_platdata(iodev
->dev
);
506 struct regulator_config config
= { };
507 struct regulator_dev
**rdev
;
508 struct s5m8767_info
*s5m8767
;
509 int i
, ret
, size
, buck_init
;
512 dev_err(pdev
->dev
.parent
, "Platform data not supplied\n");
516 if (pdata
->buck2_gpiodvs
) {
517 if (pdata
->buck3_gpiodvs
|| pdata
->buck4_gpiodvs
) {
518 dev_err(&pdev
->dev
, "S5M8767 GPIO DVS NOT VALID\n");
523 if (pdata
->buck3_gpiodvs
) {
524 if (pdata
->buck2_gpiodvs
|| pdata
->buck4_gpiodvs
) {
525 dev_err(&pdev
->dev
, "S5M8767 GPIO DVS NOT VALID\n");
530 if (pdata
->buck4_gpiodvs
) {
531 if (pdata
->buck2_gpiodvs
|| pdata
->buck3_gpiodvs
) {
532 dev_err(&pdev
->dev
, "S5M8767 GPIO DVS NOT VALID\n");
537 s5m8767
= devm_kzalloc(&pdev
->dev
, sizeof(struct s5m8767_info
),
542 size
= sizeof(struct regulator_dev
*) * (S5M8767_REG_MAX
- 2);
543 s5m8767
->rdev
= devm_kzalloc(&pdev
->dev
, size
, GFP_KERNEL
);
547 rdev
= s5m8767
->rdev
;
548 s5m8767
->dev
= &pdev
->dev
;
549 s5m8767
->iodev
= iodev
;
550 s5m8767
->num_regulators
= S5M8767_REG_MAX
- 2;
551 platform_set_drvdata(pdev
, s5m8767
);
553 s5m8767
->buck_gpioindex
= pdata
->buck_default_idx
;
554 s5m8767
->buck2_gpiodvs
= pdata
->buck2_gpiodvs
;
555 s5m8767
->buck3_gpiodvs
= pdata
->buck3_gpiodvs
;
556 s5m8767
->buck4_gpiodvs
= pdata
->buck4_gpiodvs
;
557 s5m8767
->buck_gpios
[0] = pdata
->buck_gpios
[0];
558 s5m8767
->buck_gpios
[1] = pdata
->buck_gpios
[1];
559 s5m8767
->buck_gpios
[2] = pdata
->buck_gpios
[2];
560 s5m8767
->buck_ds
[0] = pdata
->buck_ds
[0];
561 s5m8767
->buck_ds
[1] = pdata
->buck_ds
[1];
562 s5m8767
->buck_ds
[2] = pdata
->buck_ds
[2];
564 s5m8767
->ramp_delay
= pdata
->buck_ramp_delay
;
565 s5m8767
->buck2_ramp
= pdata
->buck2_ramp_enable
;
566 s5m8767
->buck3_ramp
= pdata
->buck3_ramp_enable
;
567 s5m8767
->buck4_ramp
= pdata
->buck4_ramp_enable
;
568 s5m8767
->opmode
= pdata
->opmode
;
570 buck_init
= s5m8767_convert_voltage_to_sel(&buck_voltage_val2
,
573 buck_voltage_val2
.step
);
575 sec_reg_write(s5m8767
->iodev
, S5M8767_REG_BUCK2DVS2
, buck_init
);
577 buck_init
= s5m8767_convert_voltage_to_sel(&buck_voltage_val2
,
580 buck_voltage_val2
.step
);
582 sec_reg_write(s5m8767
->iodev
, S5M8767_REG_BUCK3DVS2
, buck_init
);
584 buck_init
= s5m8767_convert_voltage_to_sel(&buck_voltage_val2
,
587 buck_voltage_val2
.step
);
589 sec_reg_write(s5m8767
->iodev
, S5M8767_REG_BUCK4DVS2
, buck_init
);
591 for (i
= 0; i
< 8; i
++) {
592 if (s5m8767
->buck2_gpiodvs
) {
593 s5m8767
->buck2_vol
[i
] =
594 s5m8767_convert_voltage_to_sel(
596 pdata
->buck2_voltage
[i
],
597 pdata
->buck2_voltage
[i
] +
598 buck_voltage_val2
.step
);
601 if (s5m8767
->buck3_gpiodvs
) {
602 s5m8767
->buck3_vol
[i
] =
603 s5m8767_convert_voltage_to_sel(
605 pdata
->buck3_voltage
[i
],
606 pdata
->buck3_voltage
[i
] +
607 buck_voltage_val2
.step
);
610 if (s5m8767
->buck4_gpiodvs
) {
611 s5m8767
->buck4_vol
[i
] =
612 s5m8767_convert_voltage_to_sel(
614 pdata
->buck4_voltage
[i
],
615 pdata
->buck4_voltage
[i
] +
616 buck_voltage_val2
.step
);
620 if (gpio_is_valid(pdata
->buck_gpios
[0]) &&
621 gpio_is_valid(pdata
->buck_gpios
[1]) &&
622 gpio_is_valid(pdata
->buck_gpios
[2])) {
623 ret
= devm_gpio_request(&pdev
->dev
, pdata
->buck_gpios
[0],
628 ret
= devm_gpio_request(&pdev
->dev
, pdata
->buck_gpios
[1],
633 ret
= devm_gpio_request(&pdev
->dev
, pdata
->buck_gpios
[2],
639 gpio_direction_output(pdata
->buck_gpios
[0],
640 (s5m8767
->buck_gpioindex
>> 2) & 0x1);
642 gpio_direction_output(pdata
->buck_gpios
[1],
643 (s5m8767
->buck_gpioindex
>> 1) & 0x1);
645 gpio_direction_output(pdata
->buck_gpios
[2],
646 (s5m8767
->buck_gpioindex
>> 0) & 0x1);
648 dev_err(&pdev
->dev
, "GPIO NOT VALID\n");
653 ret
= devm_gpio_request(&pdev
->dev
, pdata
->buck_ds
[0], "S5M8767 DS2");
657 ret
= devm_gpio_request(&pdev
->dev
, pdata
->buck_ds
[1], "S5M8767 DS3");
661 ret
= devm_gpio_request(&pdev
->dev
, pdata
->buck_ds
[2], "S5M8767 DS4");
666 gpio_direction_output(pdata
->buck_ds
[0], 0x0);
668 gpio_direction_output(pdata
->buck_ds
[1], 0x0);
670 gpio_direction_output(pdata
->buck_ds
[2], 0x0);
672 if (pdata
->buck2_gpiodvs
|| pdata
->buck3_gpiodvs
||
673 pdata
->buck4_gpiodvs
) {
674 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_BUCK2CTRL
,
675 (pdata
->buck2_gpiodvs
) ? (1 << 1) : (0 << 1),
677 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_BUCK3CTRL
,
678 (pdata
->buck3_gpiodvs
) ? (1 << 1) : (0 << 1),
680 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_BUCK4CTRL
,
681 (pdata
->buck4_gpiodvs
) ? (1 << 1) : (0 << 1),
685 /* Initialize GPIO DVS registers */
686 for (i
= 0; i
< 8; i
++) {
687 if (s5m8767
->buck2_gpiodvs
) {
688 sec_reg_write(s5m8767
->iodev
, S5M8767_REG_BUCK2DVS1
+ i
,
689 s5m8767
->buck2_vol
[i
]);
692 if (s5m8767
->buck3_gpiodvs
) {
693 sec_reg_write(s5m8767
->iodev
, S5M8767_REG_BUCK3DVS1
+ i
,
694 s5m8767
->buck3_vol
[i
]);
697 if (s5m8767
->buck4_gpiodvs
) {
698 sec_reg_write(s5m8767
->iodev
, S5M8767_REG_BUCK4DVS1
+ i
,
699 s5m8767
->buck4_vol
[i
]);
703 if (s5m8767
->buck2_ramp
)
704 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
, 0x08, 0x08);
706 if (s5m8767
->buck3_ramp
)
707 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
, 0x04, 0x04);
709 if (s5m8767
->buck4_ramp
)
710 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
, 0x02, 0x02);
712 if (s5m8767
->buck2_ramp
|| s5m8767
->buck3_ramp
713 || s5m8767
->buck4_ramp
) {
714 switch (s5m8767
->ramp_delay
) {
716 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
,
720 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
,
724 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
,
728 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
,
732 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
,
736 sec_reg_update(s5m8767
->iodev
, S5M8767_REG_DVSRAMP
,
741 for (i
= 0; i
< pdata
->num_regulators
; i
++) {
742 const struct sec_voltage_desc
*desc
;
743 int id
= pdata
->regulators
[i
].id
;
745 desc
= reg_voltage_map
[id
];
747 regulators
[id
].n_voltages
=
748 (desc
->max
- desc
->min
) / desc
->step
+ 1;
749 regulators
[id
].min_uV
= desc
->min
;
750 regulators
[id
].uV_step
= desc
->step
;
753 config
.dev
= s5m8767
->dev
;
754 config
.init_data
= pdata
->regulators
[i
].initdata
;
755 config
.driver_data
= s5m8767
;
757 rdev
[i
] = regulator_register(®ulators
[id
], &config
);
758 if (IS_ERR(rdev
[i
])) {
759 ret
= PTR_ERR(rdev
[i
]);
760 dev_err(s5m8767
->dev
, "regulator init failed for %d\n",
769 for (i
= 0; i
< s5m8767
->num_regulators
; i
++)
771 regulator_unregister(rdev
[i
]);
776 static int __devexit
s5m8767_pmic_remove(struct platform_device
*pdev
)
778 struct s5m8767_info
*s5m8767
= platform_get_drvdata(pdev
);
779 struct regulator_dev
**rdev
= s5m8767
->rdev
;
782 for (i
= 0; i
< s5m8767
->num_regulators
; i
++)
784 regulator_unregister(rdev
[i
]);
789 static const struct platform_device_id s5m8767_pmic_id
[] = {
790 { "s5m8767-pmic", 0},
793 MODULE_DEVICE_TABLE(platform
, s5m8767_pmic_id
);
795 static struct platform_driver s5m8767_pmic_driver
= {
797 .name
= "s5m8767-pmic",
798 .owner
= THIS_MODULE
,
800 .probe
= s5m8767_pmic_probe
,
801 .remove
= __devexit_p(s5m8767_pmic_remove
),
802 .id_table
= s5m8767_pmic_id
,
805 static int __init
s5m8767_pmic_init(void)
807 return platform_driver_register(&s5m8767_pmic_driver
);
809 subsys_initcall(s5m8767_pmic_init
);
811 static void __exit
s5m8767_pmic_exit(void)
813 platform_driver_unregister(&s5m8767_pmic_driver
);
815 module_exit(s5m8767_pmic_exit
);
817 /* Module information */
818 MODULE_AUTHOR("Sangbeom Kim <sbkim73@samsung.com>");
819 MODULE_DESCRIPTION("SAMSUNG S5M8767 Regulator Driver");
820 MODULE_LICENSE("GPL");