1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/bug.h>
15#include <linux/err.h>
16#include <linux/gpio.h>
17#include <linux/of_gpio.h>
18#include <linux/slab.h>
19#include <linux/module.h>
20#include <linux/platform_device.h>
21#include <linux/regulator/driver.h>
22#include <linux/regulator/machine.h>
23#include <linux/mfd/samsung/core.h>
24#include <linux/mfd/samsung/s5m8767.h>
25#include <linux/regulator/of_regulator.h>
26
27#define S5M8767_OPMODE_NORMAL_MODE 0x1
28
29struct s5m8767_info {
30 struct device *dev;
31 struct sec_pmic_dev *iodev;
32 int num_regulators;
33 struct regulator_dev **rdev;
34 struct sec_opmode_data *opmode;
35
36 int ramp_delay;
37 bool buck2_ramp;
38 bool buck3_ramp;
39 bool buck4_ramp;
40
41 bool buck2_gpiodvs;
42 bool buck3_gpiodvs;
43 bool buck4_gpiodvs;
44 u8 buck2_vol[8];
45 u8 buck3_vol[8];
46 u8 buck4_vol[8];
47 int buck_gpios[3];
48 int buck_ds[3];
49 int buck_gpioindex;
50};
51
52struct sec_voltage_desc {
53 int max;
54 int min;
55 int step;
56};
57
58static const struct sec_voltage_desc buck_voltage_val1 = {
59 .max = 2225000,
60 .min = 650000,
61 .step = 6250,
62};
63
64static const struct sec_voltage_desc buck_voltage_val2 = {
65 .max = 1600000,
66 .min = 600000,
67 .step = 6250,
68};
69
70static const struct sec_voltage_desc buck_voltage_val3 = {
71 .max = 3000000,
72 .min = 750000,
73 .step = 12500,
74};
75
76static const struct sec_voltage_desc ldo_voltage_val1 = {
77 .max = 3950000,
78 .min = 800000,
79 .step = 50000,
80};
81
82static const struct sec_voltage_desc ldo_voltage_val2 = {
83 .max = 2375000,
84 .min = 800000,
85 .step = 25000,
86};
87
88static const struct sec_voltage_desc *reg_voltage_map[] = {
89 [S5M8767_LDO1] = &ldo_voltage_val2,
90 [S5M8767_LDO2] = &ldo_voltage_val2,
91 [S5M8767_LDO3] = &ldo_voltage_val1,
92 [S5M8767_LDO4] = &ldo_voltage_val1,
93 [S5M8767_LDO5] = &ldo_voltage_val1,
94 [S5M8767_LDO6] = &ldo_voltage_val2,
95 [S5M8767_LDO7] = &ldo_voltage_val2,
96 [S5M8767_LDO8] = &ldo_voltage_val2,
97 [S5M8767_LDO9] = &ldo_voltage_val1,
98 [S5M8767_LDO10] = &ldo_voltage_val1,
99 [S5M8767_LDO11] = &ldo_voltage_val1,
100 [S5M8767_LDO12] = &ldo_voltage_val1,
101 [S5M8767_LDO13] = &ldo_voltage_val1,
102 [S5M8767_LDO14] = &ldo_voltage_val1,
103 [S5M8767_LDO15] = &ldo_voltage_val2,
104 [S5M8767_LDO16] = &ldo_voltage_val1,
105 [S5M8767_LDO17] = &ldo_voltage_val1,
106 [S5M8767_LDO18] = &ldo_voltage_val1,
107 [S5M8767_LDO19] = &ldo_voltage_val1,
108 [S5M8767_LDO20] = &ldo_voltage_val1,
109 [S5M8767_LDO21] = &ldo_voltage_val1,
110 [S5M8767_LDO22] = &ldo_voltage_val1,
111 [S5M8767_LDO23] = &ldo_voltage_val1,
112 [S5M8767_LDO24] = &ldo_voltage_val1,
113 [S5M8767_LDO25] = &ldo_voltage_val1,
114 [S5M8767_LDO26] = &ldo_voltage_val1,
115 [S5M8767_LDO27] = &ldo_voltage_val1,
116 [S5M8767_LDO28] = &ldo_voltage_val1,
117 [S5M8767_BUCK1] = &buck_voltage_val1,
118 [S5M8767_BUCK2] = &buck_voltage_val2,
119 [S5M8767_BUCK3] = &buck_voltage_val2,
120 [S5M8767_BUCK4] = &buck_voltage_val2,
121 [S5M8767_BUCK5] = &buck_voltage_val1,
122 [S5M8767_BUCK6] = &buck_voltage_val1,
123 [S5M8767_BUCK7] = NULL,
124 [S5M8767_BUCK8] = NULL,
125 [S5M8767_BUCK9] = &buck_voltage_val3,
126};
127
128static unsigned int s5m8767_opmode_reg[][4] = {
129
130
131 {0x0, 0x3, 0x2, 0x1},
132 {0x0, 0x3, 0x2, 0x1},
133 {0x0, 0x3, 0x2, 0x1},
134 {0x0, 0x0, 0x0, 0x0},
135 {0x0, 0x3, 0x2, 0x1},
136 {0x0, 0x3, 0x2, 0x1},
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},
142 {0x0, 0x3, 0x2, 0x1},
143 {0x0, 0x3, 0x2, 0x1},
144 {0x0, 0x3, 0x2, 0x1},
145 {0x0, 0x3, 0x2, 0x1},
146 {0x0, 0x3, 0x2, 0x1},
147 {0x0, 0x3, 0x2, 0x1},
148 {0x0, 0x0, 0x0, 0x0},
149 {0x0, 0x3, 0x2, 0x1},
150 {0x0, 0x3, 0x2, 0x1},
151 {0x0, 0x3, 0x2, 0x1},
152 {0x0, 0x3, 0x2, 0x1},
153 {0x0, 0x0, 0x0, 0x0},
154 {0x0, 0x3, 0x2, 0x1},
155 {0x0, 0x3, 0x2, 0x1},
156 {0x0, 0x3, 0x2, 0x1},
157 {0x0, 0x3, 0x2, 0x1},
158 {0x0, 0x3, 0x2, 0x1},
159
160
161 {0x0, 0x3, 0x1, 0x1},
162 {0x0, 0x3, 0x1, 0x1},
163 {0x0, 0x3, 0x1, 0x1},
164 {0x0, 0x3, 0x1, 0x1},
165 {0x0, 0x3, 0x2, 0x1},
166 {0x0, 0x3, 0x1, 0x1},
167 {0x0, 0x3, 0x1, 0x1},
168 {0x0, 0x3, 0x1, 0x1},
169 {0x0, 0x3, 0x1, 0x1},
170};
171
172static int s5m8767_get_register(struct regulator_dev *rdev, int *reg,
173 int *enable_ctrl)
174{
175 int i, reg_id = rdev_get_id(rdev);
176 unsigned int mode;
177 struct s5m8767_info *s5m8767 = rdev_get_drvdata(rdev);
178
179 switch (reg_id) {
180 case S5M8767_LDO1 ... S5M8767_LDO2:
181 *reg = S5M8767_REG_LDO1CTRL + (reg_id - S5M8767_LDO1);
182 break;
183 case S5M8767_LDO3 ... S5M8767_LDO28:
184 *reg = S5M8767_REG_LDO3CTRL + (reg_id - S5M8767_LDO3);
185 break;
186 case S5M8767_BUCK1:
187 *reg = S5M8767_REG_BUCK1CTRL1;
188 break;
189 case S5M8767_BUCK2 ... S5M8767_BUCK4:
190 *reg = S5M8767_REG_BUCK2CTRL + (reg_id - S5M8767_BUCK2) * 9;
191 break;
192 case S5M8767_BUCK5:
193 *reg = S5M8767_REG_BUCK5CTRL1;
194 break;
195 case S5M8767_BUCK6 ... S5M8767_BUCK9:
196 *reg = S5M8767_REG_BUCK6CTRL1 + (reg_id - S5M8767_BUCK6) * 2;
197 break;
198 default:
199 return -EINVAL;
200 }
201
202 for (i = 0; i < s5m8767->num_regulators; i++) {
203 if (s5m8767->opmode[i].id == reg_id) {
204 mode = s5m8767->opmode[i].mode;
205 break;
206 }
207 }
208
209 if (i < s5m8767->num_regulators)
210 *enable_ctrl =
211 s5m8767_opmode_reg[reg_id][mode] << S5M8767_ENCTRL_SHIFT;
212
213 return 0;
214}
215
216static int s5m8767_reg_is_enabled(struct regulator_dev *rdev)
217{
218 struct s5m8767_info *s5m8767 = rdev_get_drvdata(rdev);
219 int ret, reg;
220 int mask = 0xc0, enable_ctrl;
221 unsigned int val;
222
223 ret = s5m8767_get_register(rdev, ®, &enable_ctrl);
224 if (ret == -EINVAL)
225 return 1;
226 else if (ret)
227 return ret;
228
229 ret = sec_reg_read(s5m8767->iodev, reg, &val);
230 if (ret)
231 return ret;
232
233 return (val & mask) == enable_ctrl;
234}
235
236static int s5m8767_reg_enable(struct regulator_dev *rdev)
237{
238 struct s5m8767_info *s5m8767 = rdev_get_drvdata(rdev);
239 int ret, reg;
240 int mask = 0xc0, enable_ctrl;
241
242 ret = s5m8767_get_register(rdev, ®, &enable_ctrl);
243 if (ret)
244 return ret;
245
246 return sec_reg_update(s5m8767->iodev, reg, enable_ctrl, mask);
247}
248
249static int s5m8767_reg_disable(struct regulator_dev *rdev)
250{
251 struct s5m8767_info *s5m8767 = rdev_get_drvdata(rdev);
252 int ret, reg;
253 int mask = 0xc0, enable_ctrl;
254
255 ret = s5m8767_get_register(rdev, ®, &enable_ctrl);
256 if (ret)
257 return ret;
258
259 return sec_reg_update(s5m8767->iodev, reg, ~mask, mask);
260}
261
262static int s5m8767_get_vsel_reg(int reg_id, struct s5m8767_info *s5m8767)
263{
264 int reg;
265
266 switch (reg_id) {
267 case S5M8767_LDO1 ... S5M8767_LDO2:
268 reg = S5M8767_REG_LDO1CTRL + (reg_id - S5M8767_LDO1);
269 break;
270 case S5M8767_LDO3 ... S5M8767_LDO28:
271 reg = S5M8767_REG_LDO3CTRL + (reg_id - S5M8767_LDO3);
272 break;
273 case S5M8767_BUCK1:
274 reg = S5M8767_REG_BUCK1CTRL2;
275 break;
276 case S5M8767_BUCK2:
277 reg = S5M8767_REG_BUCK2DVS1;
278 if (s5m8767->buck2_gpiodvs)
279 reg += s5m8767->buck_gpioindex;
280 break;
281 case S5M8767_BUCK3:
282 reg = S5M8767_REG_BUCK3DVS1;
283 if (s5m8767->buck3_gpiodvs)
284 reg += s5m8767->buck_gpioindex;
285 break;
286 case S5M8767_BUCK4:
287 reg = S5M8767_REG_BUCK4DVS1;
288 if (s5m8767->buck4_gpiodvs)
289 reg += s5m8767->buck_gpioindex;
290 break;
291 case S5M8767_BUCK5:
292 reg = S5M8767_REG_BUCK5CTRL2;
293 break;
294 case S5M8767_BUCK6 ... S5M8767_BUCK9:
295 reg = S5M8767_REG_BUCK6CTRL2 + (reg_id - S5M8767_BUCK6) * 2;
296 break;
297 default:
298 return -EINVAL;
299 }
300
301 return reg;
302}
303
304static int s5m8767_convert_voltage_to_sel(const struct sec_voltage_desc *desc,
305 int min_vol)
306{
307 int selector = 0;
308
309 if (desc == NULL)
310 return -EINVAL;
311
312 if (min_vol > desc->max)
313 return -EINVAL;
314
315 if (min_vol < desc->min)
316 min_vol = desc->min;
317
318 selector = DIV_ROUND_UP(min_vol - desc->min, desc->step);
319
320 if (desc->min + desc->step * selector > desc->max)
321 return -EINVAL;
322
323 return selector;
324}
325
326static inline int s5m8767_set_high(struct s5m8767_info *s5m8767)
327{
328 int temp_index = s5m8767->buck_gpioindex;
329
330 gpio_set_value(s5m8767->buck_gpios[0], (temp_index >> 2) & 0x1);
331 gpio_set_value(s5m8767->buck_gpios[1], (temp_index >> 1) & 0x1);
332 gpio_set_value(s5m8767->buck_gpios[2], temp_index & 0x1);
333
334 return 0;
335}
336
337static inline int s5m8767_set_low(struct s5m8767_info *s5m8767)
338{
339 int temp_index = s5m8767->buck_gpioindex;
340
341 gpio_set_value(s5m8767->buck_gpios[2], temp_index & 0x1);
342 gpio_set_value(s5m8767->buck_gpios[1], (temp_index >> 1) & 0x1);
343 gpio_set_value(s5m8767->buck_gpios[0], (temp_index >> 2) & 0x1);
344
345 return 0;
346}
347
348static int s5m8767_set_voltage_sel(struct regulator_dev *rdev,
349 unsigned selector)
350{
351 struct s5m8767_info *s5m8767 = rdev_get_drvdata(rdev);
352 int reg_id = rdev_get_id(rdev);
353 int old_index, index = 0;
354 u8 *buck234_vol = NULL;
355
356 switch (reg_id) {
357 case S5M8767_LDO1 ... S5M8767_LDO28:
358 break;
359 case S5M8767_BUCK1 ... S5M8767_BUCK6:
360 if (reg_id == S5M8767_BUCK2 && s5m8767->buck2_gpiodvs)
361 buck234_vol = &s5m8767->buck2_vol[0];
362 else if (reg_id == S5M8767_BUCK3 && s5m8767->buck3_gpiodvs)
363 buck234_vol = &s5m8767->buck3_vol[0];
364 else if (reg_id == S5M8767_BUCK4 && s5m8767->buck4_gpiodvs)
365 buck234_vol = &s5m8767->buck4_vol[0];
366 break;
367 case S5M8767_BUCK7 ... S5M8767_BUCK8:
368 return -EINVAL;
369 case S5M8767_BUCK9:
370 break;
371 default:
372 return -EINVAL;
373 }
374
375
376 if (buck234_vol) {
377 while (*buck234_vol != selector) {
378 buck234_vol++;
379 index++;
380 }
381 old_index = s5m8767->buck_gpioindex;
382 s5m8767->buck_gpioindex = index;
383
384 if (index > old_index)
385 return s5m8767_set_high(s5m8767);
386 else
387 return s5m8767_set_low(s5m8767);
388 } else {
389 return regulator_set_voltage_sel_regmap(rdev, selector);
390 }
391}
392
393static int s5m8767_set_voltage_time_sel(struct regulator_dev *rdev,
394 unsigned int old_sel,
395 unsigned int new_sel)
396{
397 struct s5m8767_info *s5m8767 = rdev_get_drvdata(rdev);
398 const struct sec_voltage_desc *desc;
399 int reg_id = rdev_get_id(rdev);
400
401 desc = reg_voltage_map[reg_id];
402
403 if ((old_sel < new_sel) && s5m8767->ramp_delay)
404 return DIV_ROUND_UP(desc->step * (new_sel - old_sel),
405 s5m8767->ramp_delay * 1000);
406 return 0;
407}
408
409static struct regulator_ops s5m8767_ops = {
410 .list_voltage = regulator_list_voltage_linear,
411 .is_enabled = s5m8767_reg_is_enabled,
412 .enable = s5m8767_reg_enable,
413 .disable = s5m8767_reg_disable,
414 .get_voltage_sel = regulator_get_voltage_sel_regmap,
415 .set_voltage_sel = s5m8767_set_voltage_sel,
416 .set_voltage_time_sel = s5m8767_set_voltage_time_sel,
417};
418
419static struct regulator_ops s5m8767_buck78_ops = {
420 .is_enabled = s5m8767_reg_is_enabled,
421 .enable = s5m8767_reg_enable,
422 .disable = s5m8767_reg_disable,
423};
424
425#define s5m8767_regulator_desc(_name) { \
426 .name = #_name, \
427 .id = S5M8767_##_name, \
428 .ops = &s5m8767_ops, \
429 .type = REGULATOR_VOLTAGE, \
430 .owner = THIS_MODULE, \
431}
432
433#define s5m8767_regulator_buck78_desc(_name) { \
434 .name = #_name, \
435 .id = S5M8767_##_name, \
436 .ops = &s5m8767_buck78_ops, \
437 .type = REGULATOR_VOLTAGE, \
438 .owner = THIS_MODULE, \
439}
440
441static struct regulator_desc regulators[] = {
442 s5m8767_regulator_desc(LDO1),
443 s5m8767_regulator_desc(LDO2),
444 s5m8767_regulator_desc(LDO3),
445 s5m8767_regulator_desc(LDO4),
446 s5m8767_regulator_desc(LDO5),
447 s5m8767_regulator_desc(LDO6),
448 s5m8767_regulator_desc(LDO7),
449 s5m8767_regulator_desc(LDO8),
450 s5m8767_regulator_desc(LDO9),
451 s5m8767_regulator_desc(LDO10),
452 s5m8767_regulator_desc(LDO11),
453 s5m8767_regulator_desc(LDO12),
454 s5m8767_regulator_desc(LDO13),
455 s5m8767_regulator_desc(LDO14),
456 s5m8767_regulator_desc(LDO15),
457 s5m8767_regulator_desc(LDO16),
458 s5m8767_regulator_desc(LDO17),
459 s5m8767_regulator_desc(LDO18),
460 s5m8767_regulator_desc(LDO19),
461 s5m8767_regulator_desc(LDO20),
462 s5m8767_regulator_desc(LDO21),
463 s5m8767_regulator_desc(LDO22),
464 s5m8767_regulator_desc(LDO23),
465 s5m8767_regulator_desc(LDO24),
466 s5m8767_regulator_desc(LDO25),
467 s5m8767_regulator_desc(LDO26),
468 s5m8767_regulator_desc(LDO27),
469 s5m8767_regulator_desc(LDO28),
470 s5m8767_regulator_desc(BUCK1),
471 s5m8767_regulator_desc(BUCK2),
472 s5m8767_regulator_desc(BUCK3),
473 s5m8767_regulator_desc(BUCK4),
474 s5m8767_regulator_desc(BUCK5),
475 s5m8767_regulator_desc(BUCK6),
476 s5m8767_regulator_buck78_desc(BUCK7),
477 s5m8767_regulator_buck78_desc(BUCK8),
478 s5m8767_regulator_desc(BUCK9),
479};
480
481#ifdef CONFIG_OF
482static int s5m8767_pmic_dt_parse_dvs_gpio(struct sec_pmic_dev *iodev,
483 struct sec_platform_data *pdata,
484 struct device_node *pmic_np)
485{
486 int i, gpio;
487
488 for (i = 0; i < 3; i++) {
489 gpio = of_get_named_gpio(pmic_np,
490 "s5m8767,pmic-buck-dvs-gpios", i);
491 if (!gpio_is_valid(gpio)) {
492 dev_err(iodev->dev, "invalid gpio[%d]: %d\n", i, gpio);
493 return -EINVAL;
494 }
495 pdata->buck_gpios[i] = gpio;
496 }
497 return 0;
498}
499
500static int s5m8767_pmic_dt_parse_ds_gpio(struct sec_pmic_dev *iodev,
501 struct sec_platform_data *pdata,
502 struct device_node *pmic_np)
503{
504 int i, gpio;
505
506 for (i = 0; i < 3; i++) {
507 gpio = of_get_named_gpio(pmic_np,
508 "s5m8767,pmic-buck-ds-gpios", i);
509 if (!gpio_is_valid(gpio)) {
510 dev_err(iodev->dev, "invalid gpio[%d]: %d\n", i, gpio);
511 return -EINVAL;
512 }
513 pdata->buck_ds[i] = gpio;
514 }
515 return 0;
516}
517
518static int s5m8767_pmic_dt_parse_pdata(struct platform_device *pdev,
519 struct sec_platform_data *pdata)
520{
521 struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent);
522 struct device_node *pmic_np, *regulators_np, *reg_np;
523 struct sec_regulator_data *rdata;
524 struct sec_opmode_data *rmode;
525 unsigned int i, dvs_voltage_nr = 1, ret;
526
527 pmic_np = iodev->dev->of_node;
528 if (!pmic_np) {
529 dev_err(iodev->dev, "could not find pmic sub-node\n");
530 return -ENODEV;
531 }
532
533 regulators_np = of_find_node_by_name(pmic_np, "regulators");
534 if (!regulators_np) {
535 dev_err(iodev->dev, "could not find regulators sub-node\n");
536 return -EINVAL;
537 }
538
539
540 pdata->num_regulators = of_get_child_count(regulators_np);
541
542 rdata = devm_kzalloc(&pdev->dev, sizeof(*rdata) *
543 pdata->num_regulators, GFP_KERNEL);
544 if (!rdata) {
545 dev_err(iodev->dev,
546 "could not allocate memory for regulator data\n");
547 return -ENOMEM;
548 }
549
550 rmode = devm_kzalloc(&pdev->dev, sizeof(*rmode) *
551 pdata->num_regulators, GFP_KERNEL);
552 if (!rdata) {
553 dev_err(iodev->dev,
554 "could not allocate memory for regulator mode\n");
555 return -ENOMEM;
556 }
557
558 pdata->regulators = rdata;
559 pdata->opmode = rmode;
560 for_each_child_of_node(regulators_np, reg_np) {
561 for (i = 0; i < ARRAY_SIZE(regulators); i++)
562 if (!of_node_cmp(reg_np->name, regulators[i].name))
563 break;
564
565 if (i == ARRAY_SIZE(regulators)) {
566 dev_warn(iodev->dev,
567 "don't know how to configure regulator %s\n",
568 reg_np->name);
569 continue;
570 }
571
572 rdata->id = i;
573 rdata->initdata = of_get_regulator_init_data(
574 &pdev->dev, reg_np);
575 rdata->reg_node = reg_np;
576 rdata++;
577 rmode->id = i;
578 if (of_property_read_u32(reg_np, "op_mode",
579 &rmode->mode)) {
580 dev_warn(iodev->dev,
581 "no op_mode property property at %s\n",
582 reg_np->full_name);
583
584 rmode->mode = S5M8767_OPMODE_NORMAL_MODE;
585 }
586 rmode++;
587 }
588
589 if (of_get_property(pmic_np, "s5m8767,pmic-buck2-uses-gpio-dvs", NULL))
590 pdata->buck2_gpiodvs = true;
591
592 if (of_get_property(pmic_np, "s5m8767,pmic-buck3-uses-gpio-dvs", NULL))
593 pdata->buck3_gpiodvs = true;
594
595 if (of_get_property(pmic_np, "s5m8767,pmic-buck4-uses-gpio-dvs", NULL))
596 pdata->buck4_gpiodvs = true;
597
598 if (pdata->buck2_gpiodvs || pdata->buck3_gpiodvs ||
599 pdata->buck4_gpiodvs) {
600 ret = s5m8767_pmic_dt_parse_dvs_gpio(iodev, pdata, pmic_np);
601 if (ret)
602 return -EINVAL;
603
604 if (of_property_read_u32(pmic_np,
605 "s5m8767,pmic-buck-default-dvs-idx",
606 &pdata->buck_default_idx)) {
607 pdata->buck_default_idx = 0;
608 } else {
609 if (pdata->buck_default_idx >= 8) {
610 pdata->buck_default_idx = 0;
611 dev_info(iodev->dev,
612 "invalid value for default dvs index, use 0\n");
613 }
614 }
615 dvs_voltage_nr = 8;
616 }
617
618 ret = s5m8767_pmic_dt_parse_ds_gpio(iodev, pdata, pmic_np);
619 if (ret)
620 return -EINVAL;
621
622 if (of_property_read_u32_array(pmic_np,
623 "s5m8767,pmic-buck2-dvs-voltage",
624 pdata->buck2_voltage, dvs_voltage_nr)) {
625 dev_err(iodev->dev, "buck2 voltages not specified\n");
626 return -EINVAL;
627 }
628
629 if (of_property_read_u32_array(pmic_np,
630 "s5m8767,pmic-buck3-dvs-voltage",
631 pdata->buck3_voltage, dvs_voltage_nr)) {
632 dev_err(iodev->dev, "buck3 voltages not specified\n");
633 return -EINVAL;
634 }
635
636 if (of_property_read_u32_array(pmic_np,
637 "s5m8767,pmic-buck4-dvs-voltage",
638 pdata->buck4_voltage, dvs_voltage_nr)) {
639 dev_err(iodev->dev, "buck4 voltages not specified\n");
640 return -EINVAL;
641 }
642
643 return 0;
644}
645#else
646static int s5m8767_pmic_dt_parse_pdata(struct platform_device *pdev,
647 struct sec_platform_data *pdata)
648{
649 return 0;
650}
651#endif
652
653static int s5m8767_pmic_probe(struct platform_device *pdev)
654{
655 struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent);
656 struct sec_platform_data *pdata = iodev->pdata;
657 struct regulator_config config = { };
658 struct regulator_dev **rdev;
659 struct s5m8767_info *s5m8767;
660 int i, ret, size, buck_init;
661
662 if (!pdata) {
663 dev_err(pdev->dev.parent, "Platform data not supplied\n");
664 return -ENODEV;
665 }
666
667 if (iodev->dev->of_node) {
668 ret = s5m8767_pmic_dt_parse_pdata(pdev, pdata);
669 if (ret)
670 return ret;
671 }
672
673 if (pdata->buck2_gpiodvs) {
674 if (pdata->buck3_gpiodvs || pdata->buck4_gpiodvs) {
675 dev_err(&pdev->dev, "S5M8767 GPIO DVS NOT VALID\n");
676 return -EINVAL;
677 }
678 }
679
680 if (pdata->buck3_gpiodvs) {
681 if (pdata->buck2_gpiodvs || pdata->buck4_gpiodvs) {
682 dev_err(&pdev->dev, "S5M8767 GPIO DVS NOT VALID\n");
683 return -EINVAL;
684 }
685 }
686
687 if (pdata->buck4_gpiodvs) {
688 if (pdata->buck2_gpiodvs || pdata->buck3_gpiodvs) {
689 dev_err(&pdev->dev, "S5M8767 GPIO DVS NOT VALID\n");
690 return -EINVAL;
691 }
692 }
693
694 s5m8767 = devm_kzalloc(&pdev->dev, sizeof(struct s5m8767_info),
695 GFP_KERNEL);
696 if (!s5m8767)
697 return -ENOMEM;
698
699 size = sizeof(struct regulator_dev *) * (S5M8767_REG_MAX - 2);
700 s5m8767->rdev = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
701 if (!s5m8767->rdev)
702 return -ENOMEM;
703
704 rdev = s5m8767->rdev;
705 s5m8767->dev = &pdev->dev;
706 s5m8767->iodev = iodev;
707 s5m8767->num_regulators = pdata->num_regulators;
708 platform_set_drvdata(pdev, s5m8767);
709
710 s5m8767->buck_gpioindex = pdata->buck_default_idx;
711 s5m8767->buck2_gpiodvs = pdata->buck2_gpiodvs;
712 s5m8767->buck3_gpiodvs = pdata->buck3_gpiodvs;
713 s5m8767->buck4_gpiodvs = pdata->buck4_gpiodvs;
714 s5m8767->buck_gpios[0] = pdata->buck_gpios[0];
715 s5m8767->buck_gpios[1] = pdata->buck_gpios[1];
716 s5m8767->buck_gpios[2] = pdata->buck_gpios[2];
717 s5m8767->buck_ds[0] = pdata->buck_ds[0];
718 s5m8767->buck_ds[1] = pdata->buck_ds[1];
719 s5m8767->buck_ds[2] = pdata->buck_ds[2];
720
721 s5m8767->ramp_delay = pdata->buck_ramp_delay;
722 s5m8767->buck2_ramp = pdata->buck2_ramp_enable;
723 s5m8767->buck3_ramp = pdata->buck3_ramp_enable;
724 s5m8767->buck4_ramp = pdata->buck4_ramp_enable;
725 s5m8767->opmode = pdata->opmode;
726
727 buck_init = s5m8767_convert_voltage_to_sel(&buck_voltage_val2,
728 pdata->buck2_init);
729
730 sec_reg_write(s5m8767->iodev, S5M8767_REG_BUCK2DVS2, buck_init);
731
732 buck_init = s5m8767_convert_voltage_to_sel(&buck_voltage_val2,
733 pdata->buck3_init);
734
735 sec_reg_write(s5m8767->iodev, S5M8767_REG_BUCK3DVS2, buck_init);
736
737 buck_init = s5m8767_convert_voltage_to_sel(&buck_voltage_val2,
738 pdata->buck4_init);
739
740 sec_reg_write(s5m8767->iodev, S5M8767_REG_BUCK4DVS2, buck_init);
741
742 for (i = 0; i < 8; i++) {
743 if (s5m8767->buck2_gpiodvs) {
744 s5m8767->buck2_vol[i] =
745 s5m8767_convert_voltage_to_sel(
746 &buck_voltage_val2,
747 pdata->buck2_voltage[i]);
748 }
749
750 if (s5m8767->buck3_gpiodvs) {
751 s5m8767->buck3_vol[i] =
752 s5m8767_convert_voltage_to_sel(
753 &buck_voltage_val2,
754 pdata->buck3_voltage[i]);
755 }
756
757 if (s5m8767->buck4_gpiodvs) {
758 s5m8767->buck4_vol[i] =
759 s5m8767_convert_voltage_to_sel(
760 &buck_voltage_val2,
761 pdata->buck4_voltage[i]);
762 }
763 }
764
765 if (pdata->buck2_gpiodvs || pdata->buck3_gpiodvs ||
766 pdata->buck4_gpiodvs) {
767
768 if (!gpio_is_valid(pdata->buck_gpios[0]) ||
769 !gpio_is_valid(pdata->buck_gpios[1]) ||
770 !gpio_is_valid(pdata->buck_gpios[2])) {
771 dev_err(&pdev->dev, "GPIO NOT VALID\n");
772 return -EINVAL;
773 }
774
775 ret = devm_gpio_request(&pdev->dev, pdata->buck_gpios[0],
776 "S5M8767 SET1");
777 if (ret)
778 return ret;
779
780 ret = devm_gpio_request(&pdev->dev, pdata->buck_gpios[1],
781 "S5M8767 SET2");
782 if (ret)
783 return ret;
784
785 ret = devm_gpio_request(&pdev->dev, pdata->buck_gpios[2],
786 "S5M8767 SET3");
787 if (ret)
788 return ret;
789
790
791 gpio_direction_output(pdata->buck_gpios[0],
792 (s5m8767->buck_gpioindex >> 2) & 0x1);
793
794 gpio_direction_output(pdata->buck_gpios[1],
795 (s5m8767->buck_gpioindex >> 1) & 0x1);
796
797 gpio_direction_output(pdata->buck_gpios[2],
798 (s5m8767->buck_gpioindex >> 0) & 0x1);
799 }
800
801 ret = devm_gpio_request(&pdev->dev, pdata->buck_ds[0], "S5M8767 DS2");
802 if (ret)
803 return ret;
804
805 ret = devm_gpio_request(&pdev->dev, pdata->buck_ds[1], "S5M8767 DS3");
806 if (ret)
807 return ret;
808
809 ret = devm_gpio_request(&pdev->dev, pdata->buck_ds[2], "S5M8767 DS4");
810 if (ret)
811 return ret;
812
813
814 gpio_direction_output(pdata->buck_ds[0], 0x0);
815
816 gpio_direction_output(pdata->buck_ds[1], 0x0);
817
818 gpio_direction_output(pdata->buck_ds[2], 0x0);
819
820 if (pdata->buck2_gpiodvs || pdata->buck3_gpiodvs ||
821 pdata->buck4_gpiodvs) {
822 sec_reg_update(s5m8767->iodev, S5M8767_REG_BUCK2CTRL,
823 (pdata->buck2_gpiodvs) ? (1 << 1) : (0 << 1),
824 1 << 1);
825 sec_reg_update(s5m8767->iodev, S5M8767_REG_BUCK3CTRL,
826 (pdata->buck3_gpiodvs) ? (1 << 1) : (0 << 1),
827 1 << 1);
828 sec_reg_update(s5m8767->iodev, S5M8767_REG_BUCK4CTRL,
829 (pdata->buck4_gpiodvs) ? (1 << 1) : (0 << 1),
830 1 << 1);
831 }
832
833
834 for (i = 0; i < 8; i++) {
835 if (s5m8767->buck2_gpiodvs) {
836 sec_reg_write(s5m8767->iodev, S5M8767_REG_BUCK2DVS1 + i,
837 s5m8767->buck2_vol[i]);
838 }
839
840 if (s5m8767->buck3_gpiodvs) {
841 sec_reg_write(s5m8767->iodev, S5M8767_REG_BUCK3DVS1 + i,
842 s5m8767->buck3_vol[i]);
843 }
844
845 if (s5m8767->buck4_gpiodvs) {
846 sec_reg_write(s5m8767->iodev, S5M8767_REG_BUCK4DVS1 + i,
847 s5m8767->buck4_vol[i]);
848 }
849 }
850
851 if (s5m8767->buck2_ramp)
852 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP, 0x08, 0x08);
853
854 if (s5m8767->buck3_ramp)
855 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP, 0x04, 0x04);
856
857 if (s5m8767->buck4_ramp)
858 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP, 0x02, 0x02);
859
860 if (s5m8767->buck2_ramp || s5m8767->buck3_ramp
861 || s5m8767->buck4_ramp) {
862 switch (s5m8767->ramp_delay) {
863 case 5:
864 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP,
865 0x40, 0xf0);
866 break;
867 case 10:
868 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP,
869 0x90, 0xf0);
870 break;
871 case 25:
872 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP,
873 0xd0, 0xf0);
874 break;
875 case 50:
876 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP,
877 0xe0, 0xf0);
878 break;
879 case 100:
880 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP,
881 0xf0, 0xf0);
882 break;
883 default:
884 sec_reg_update(s5m8767->iodev, S5M8767_REG_DVSRAMP,
885 0x90, 0xf0);
886 }
887 }
888
889 for (i = 0; i < pdata->num_regulators; i++) {
890 const struct sec_voltage_desc *desc;
891 int id = pdata->regulators[i].id;
892
893 desc = reg_voltage_map[id];
894 if (desc) {
895 regulators[id].n_voltages =
896 (desc->max - desc->min) / desc->step + 1;
897 regulators[id].min_uV = desc->min;
898 regulators[id].uV_step = desc->step;
899 regulators[id].vsel_reg =
900 s5m8767_get_vsel_reg(id, s5m8767);
901 if (id < S5M8767_BUCK1)
902 regulators[id].vsel_mask = 0x3f;
903 else
904 regulators[id].vsel_mask = 0xff;
905 }
906
907 config.dev = s5m8767->dev;
908 config.init_data = pdata->regulators[i].initdata;
909 config.driver_data = s5m8767;
910 config.regmap = iodev->regmap;
911 config.of_node = pdata->regulators[i].reg_node;
912
913 rdev[i] = regulator_register(®ulators[id], &config);
914 if (IS_ERR(rdev[i])) {
915 ret = PTR_ERR(rdev[i]);
916 dev_err(s5m8767->dev, "regulator init failed for %d\n",
917 id);
918 rdev[i] = NULL;
919 goto err;
920 }
921 }
922
923 return 0;
924err:
925 for (i = 0; i < s5m8767->num_regulators; i++)
926 if (rdev[i])
927 regulator_unregister(rdev[i]);
928
929 return ret;
930}
931
932static int s5m8767_pmic_remove(struct platform_device *pdev)
933{
934 struct s5m8767_info *s5m8767 = platform_get_drvdata(pdev);
935 struct regulator_dev **rdev = s5m8767->rdev;
936 int i;
937
938 for (i = 0; i < s5m8767->num_regulators; i++)
939 if (rdev[i])
940 regulator_unregister(rdev[i]);
941
942 return 0;
943}
944
945static const struct platform_device_id s5m8767_pmic_id[] = {
946 { "s5m8767-pmic", 0},
947 { },
948};
949MODULE_DEVICE_TABLE(platform, s5m8767_pmic_id);
950
951static struct platform_driver s5m8767_pmic_driver = {
952 .driver = {
953 .name = "s5m8767-pmic",
954 .owner = THIS_MODULE,
955 },
956 .probe = s5m8767_pmic_probe,
957 .remove = s5m8767_pmic_remove,
958 .id_table = s5m8767_pmic_id,
959};
960
961static int __init s5m8767_pmic_init(void)
962{
963 return platform_driver_register(&s5m8767_pmic_driver);
964}
965subsys_initcall(s5m8767_pmic_init);
966
967static void __exit s5m8767_pmic_exit(void)
968{
969 platform_driver_unregister(&s5m8767_pmic_driver);
970}
971module_exit(s5m8767_pmic_exit);
972
973
974MODULE_AUTHOR("Sangbeom Kim <sbkim73@samsung.com>");
975MODULE_DESCRIPTION("SAMSUNG S5M8767 Regulator Driver");
976MODULE_LICENSE("GPL");
977
