4 * Copyright (c) 2012-2014 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.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
19 #include <linux/bug.h>
20 #include <linux/err.h>
21 #include <linux/gpio.h>
22 #include <linux/slab.h>
23 #include <linux/module.h>
25 #include <linux/regmap.h>
26 #include <linux/platform_device.h>
27 #include <linux/regulator/driver.h>
28 #include <linux/regulator/machine.h>
29 #include <linux/regulator/of_regulator.h>
30 #include <linux/of_gpio.h>
31 #include <linux/mfd/samsung/core.h>
32 #include <linux/mfd/samsung/s2mps11.h>
33 #include <linux/mfd/samsung/s2mps14.h>
36 unsigned int rdev_num;
44 * One bit for each S2MPS14 regulator whether the suspend mode
47 unsigned int s2mps14_suspend_state:30;
48 /* Array of size rdev_num with GPIO-s for external sleep control */
49 int *ext_control_gpio;
52 static int get_ramp_delay(int ramp_delay)
54 unsigned char cnt = 0;
59 ramp_delay = ramp_delay >> 1;
71 static int s2mps11_regulator_set_voltage_time_sel(struct regulator_dev *rdev,
72 unsigned int old_selector,
73 unsigned int new_selector)
75 struct s2mps11_info *s2mps11 = rdev_get_drvdata(rdev);
76 unsigned int ramp_delay = 0;
77 int old_volt, new_volt;
79 switch (rdev_get_id(rdev)) {
81 ramp_delay = s2mps11->ramp_delay2;
85 ramp_delay = s2mps11->ramp_delay34;
88 ramp_delay = s2mps11->ramp_delay5;
92 ramp_delay = s2mps11->ramp_delay16;
97 ramp_delay = s2mps11->ramp_delay7810;
100 ramp_delay = s2mps11->ramp_delay9;
104 ramp_delay = rdev->desc->ramp_delay;
106 old_volt = rdev->desc->min_uV + (rdev->desc->uV_step * old_selector);
107 new_volt = rdev->desc->min_uV + (rdev->desc->uV_step * new_selector);
109 return DIV_ROUND_UP(abs(new_volt - old_volt), ramp_delay);
112 static int s2mps11_set_ramp_delay(struct regulator_dev *rdev, int ramp_delay)
114 struct s2mps11_info *s2mps11 = rdev_get_drvdata(rdev);
115 unsigned int ramp_val, ramp_shift, ramp_reg = S2MPS11_REG_RAMP_BUCK;
116 unsigned int ramp_enable = 1, enable_shift = 0;
119 switch (rdev_get_id(rdev)) {
121 if (ramp_delay > s2mps11->ramp_delay16)
122 s2mps11->ramp_delay16 = ramp_delay;
124 ramp_delay = s2mps11->ramp_delay16;
126 ramp_shift = S2MPS11_BUCK16_RAMP_SHIFT;
129 enable_shift = S2MPS11_BUCK2_RAMP_EN_SHIFT;
135 s2mps11->ramp_delay2 = ramp_delay;
136 ramp_shift = S2MPS11_BUCK2_RAMP_SHIFT;
137 ramp_reg = S2MPS11_REG_RAMP;
140 enable_shift = S2MPS11_BUCK3_RAMP_EN_SHIFT;
146 if (ramp_delay > s2mps11->ramp_delay34)
147 s2mps11->ramp_delay34 = ramp_delay;
149 ramp_delay = s2mps11->ramp_delay34;
151 ramp_shift = S2MPS11_BUCK34_RAMP_SHIFT;
152 ramp_reg = S2MPS11_REG_RAMP;
155 enable_shift = S2MPS11_BUCK4_RAMP_EN_SHIFT;
161 if (ramp_delay > s2mps11->ramp_delay34)
162 s2mps11->ramp_delay34 = ramp_delay;
164 ramp_delay = s2mps11->ramp_delay34;
166 ramp_shift = S2MPS11_BUCK34_RAMP_SHIFT;
167 ramp_reg = S2MPS11_REG_RAMP;
170 s2mps11->ramp_delay5 = ramp_delay;
171 ramp_shift = S2MPS11_BUCK5_RAMP_SHIFT;
174 enable_shift = S2MPS11_BUCK6_RAMP_EN_SHIFT;
180 if (ramp_delay > s2mps11->ramp_delay16)
181 s2mps11->ramp_delay16 = ramp_delay;
183 ramp_delay = s2mps11->ramp_delay16;
185 ramp_shift = S2MPS11_BUCK16_RAMP_SHIFT;
190 if (ramp_delay > s2mps11->ramp_delay7810)
191 s2mps11->ramp_delay7810 = ramp_delay;
193 ramp_delay = s2mps11->ramp_delay7810;
195 ramp_shift = S2MPS11_BUCK7810_RAMP_SHIFT;
198 s2mps11->ramp_delay9 = ramp_delay;
199 ramp_shift = S2MPS11_BUCK9_RAMP_SHIFT;
208 ret = regmap_update_bits(rdev->regmap, S2MPS11_REG_RAMP,
209 1 << enable_shift, 1 << enable_shift);
211 dev_err(&rdev->dev, "failed to enable ramp rate\n");
215 ramp_val = get_ramp_delay(ramp_delay);
217 return regmap_update_bits(rdev->regmap, ramp_reg, 0x3 << ramp_shift,
218 ramp_val << ramp_shift);
221 return regmap_update_bits(rdev->regmap, S2MPS11_REG_RAMP,
222 1 << enable_shift, 0);
225 static struct regulator_ops s2mps11_ldo_ops = {
226 .list_voltage = regulator_list_voltage_linear,
227 .map_voltage = regulator_map_voltage_linear,
228 .is_enabled = regulator_is_enabled_regmap,
229 .enable = regulator_enable_regmap,
230 .disable = regulator_disable_regmap,
231 .get_voltage_sel = regulator_get_voltage_sel_regmap,
232 .set_voltage_sel = regulator_set_voltage_sel_regmap,
233 .set_voltage_time_sel = regulator_set_voltage_time_sel,
236 static struct regulator_ops s2mps11_buck_ops = {
237 .list_voltage = regulator_list_voltage_linear,
238 .map_voltage = regulator_map_voltage_linear,
239 .is_enabled = regulator_is_enabled_regmap,
240 .enable = regulator_enable_regmap,
241 .disable = regulator_disable_regmap,
242 .get_voltage_sel = regulator_get_voltage_sel_regmap,
243 .set_voltage_sel = regulator_set_voltage_sel_regmap,
244 .set_voltage_time_sel = s2mps11_regulator_set_voltage_time_sel,
245 .set_ramp_delay = s2mps11_set_ramp_delay,
248 #define regulator_desc_s2mps11_ldo1(num) { \
250 .id = S2MPS11_LDO##num, \
251 .ops = &s2mps11_ldo_ops, \
252 .type = REGULATOR_VOLTAGE, \
253 .owner = THIS_MODULE, \
254 .min_uV = S2MPS11_LDO_MIN, \
255 .uV_step = S2MPS11_LDO_STEP1, \
256 .n_voltages = S2MPS11_LDO_N_VOLTAGES, \
257 .vsel_reg = S2MPS11_REG_L1CTRL + num - 1, \
258 .vsel_mask = S2MPS11_LDO_VSEL_MASK, \
259 .enable_reg = S2MPS11_REG_L1CTRL + num - 1, \
260 .enable_mask = S2MPS11_ENABLE_MASK \
262 #define regulator_desc_s2mps11_ldo2(num) { \
264 .id = S2MPS11_LDO##num, \
265 .ops = &s2mps11_ldo_ops, \
266 .type = REGULATOR_VOLTAGE, \
267 .owner = THIS_MODULE, \
268 .min_uV = S2MPS11_LDO_MIN, \
269 .uV_step = S2MPS11_LDO_STEP2, \
270 .n_voltages = S2MPS11_LDO_N_VOLTAGES, \
271 .vsel_reg = S2MPS11_REG_L1CTRL + num - 1, \
272 .vsel_mask = S2MPS11_LDO_VSEL_MASK, \
273 .enable_reg = S2MPS11_REG_L1CTRL + num - 1, \
274 .enable_mask = S2MPS11_ENABLE_MASK \
277 #define regulator_desc_s2mps11_buck1_4(num) { \
278 .name = "BUCK"#num, \
279 .id = S2MPS11_BUCK##num, \
280 .ops = &s2mps11_buck_ops, \
281 .type = REGULATOR_VOLTAGE, \
282 .owner = THIS_MODULE, \
283 .min_uV = S2MPS11_BUCK_MIN1, \
284 .uV_step = S2MPS11_BUCK_STEP1, \
285 .n_voltages = S2MPS11_BUCK_N_VOLTAGES, \
286 .ramp_delay = S2MPS11_RAMP_DELAY, \
287 .vsel_reg = S2MPS11_REG_B1CTRL2 + (num - 1) * 2, \
288 .vsel_mask = S2MPS11_BUCK_VSEL_MASK, \
289 .enable_reg = S2MPS11_REG_B1CTRL1 + (num - 1) * 2, \
290 .enable_mask = S2MPS11_ENABLE_MASK \
293 #define regulator_desc_s2mps11_buck5 { \
295 .id = S2MPS11_BUCK5, \
296 .ops = &s2mps11_buck_ops, \
297 .type = REGULATOR_VOLTAGE, \
298 .owner = THIS_MODULE, \
299 .min_uV = S2MPS11_BUCK_MIN1, \
300 .uV_step = S2MPS11_BUCK_STEP1, \
301 .n_voltages = S2MPS11_BUCK_N_VOLTAGES, \
302 .ramp_delay = S2MPS11_RAMP_DELAY, \
303 .vsel_reg = S2MPS11_REG_B5CTRL2, \
304 .vsel_mask = S2MPS11_BUCK_VSEL_MASK, \
305 .enable_reg = S2MPS11_REG_B5CTRL1, \
306 .enable_mask = S2MPS11_ENABLE_MASK \
309 #define regulator_desc_s2mps11_buck6_8(num) { \
310 .name = "BUCK"#num, \
311 .id = S2MPS11_BUCK##num, \
312 .ops = &s2mps11_buck_ops, \
313 .type = REGULATOR_VOLTAGE, \
314 .owner = THIS_MODULE, \
315 .min_uV = S2MPS11_BUCK_MIN1, \
316 .uV_step = S2MPS11_BUCK_STEP1, \
317 .n_voltages = S2MPS11_BUCK_N_VOLTAGES, \
318 .ramp_delay = S2MPS11_RAMP_DELAY, \
319 .vsel_reg = S2MPS11_REG_B6CTRL2 + (num - 6) * 2, \
320 .vsel_mask = S2MPS11_BUCK_VSEL_MASK, \
321 .enable_reg = S2MPS11_REG_B6CTRL1 + (num - 6) * 2, \
322 .enable_mask = S2MPS11_ENABLE_MASK \
325 #define regulator_desc_s2mps11_buck9 { \
327 .id = S2MPS11_BUCK9, \
328 .ops = &s2mps11_buck_ops, \
329 .type = REGULATOR_VOLTAGE, \
330 .owner = THIS_MODULE, \
331 .min_uV = S2MPS11_BUCK_MIN3, \
332 .uV_step = S2MPS11_BUCK_STEP3, \
333 .n_voltages = S2MPS11_BUCK_N_VOLTAGES, \
334 .ramp_delay = S2MPS11_RAMP_DELAY, \
335 .vsel_reg = S2MPS11_REG_B9CTRL2, \
336 .vsel_mask = S2MPS11_BUCK_VSEL_MASK, \
337 .enable_reg = S2MPS11_REG_B9CTRL1, \
338 .enable_mask = S2MPS11_ENABLE_MASK \
341 #define regulator_desc_s2mps11_buck10 { \
343 .id = S2MPS11_BUCK10, \
344 .ops = &s2mps11_buck_ops, \
345 .type = REGULATOR_VOLTAGE, \
346 .owner = THIS_MODULE, \
347 .min_uV = S2MPS11_BUCK_MIN2, \
348 .uV_step = S2MPS11_BUCK_STEP2, \
349 .n_voltages = S2MPS11_BUCK_N_VOLTAGES, \
350 .ramp_delay = S2MPS11_RAMP_DELAY, \
351 .vsel_reg = S2MPS11_REG_B10CTRL2, \
352 .vsel_mask = S2MPS11_BUCK_VSEL_MASK, \
353 .enable_reg = S2MPS11_REG_B10CTRL1, \
354 .enable_mask = S2MPS11_ENABLE_MASK \
357 static const struct regulator_desc s2mps11_regulators[] = {
358 regulator_desc_s2mps11_ldo2(1),
359 regulator_desc_s2mps11_ldo1(2),
360 regulator_desc_s2mps11_ldo1(3),
361 regulator_desc_s2mps11_ldo1(4),
362 regulator_desc_s2mps11_ldo1(5),
363 regulator_desc_s2mps11_ldo2(6),
364 regulator_desc_s2mps11_ldo1(7),
365 regulator_desc_s2mps11_ldo1(8),
366 regulator_desc_s2mps11_ldo1(9),
367 regulator_desc_s2mps11_ldo1(10),
368 regulator_desc_s2mps11_ldo2(11),
369 regulator_desc_s2mps11_ldo1(12),
370 regulator_desc_s2mps11_ldo1(13),
371 regulator_desc_s2mps11_ldo1(14),
372 regulator_desc_s2mps11_ldo1(15),
373 regulator_desc_s2mps11_ldo1(16),
374 regulator_desc_s2mps11_ldo1(17),
375 regulator_desc_s2mps11_ldo1(18),
376 regulator_desc_s2mps11_ldo1(19),
377 regulator_desc_s2mps11_ldo1(20),
378 regulator_desc_s2mps11_ldo1(21),
379 regulator_desc_s2mps11_ldo2(22),
380 regulator_desc_s2mps11_ldo2(23),
381 regulator_desc_s2mps11_ldo1(24),
382 regulator_desc_s2mps11_ldo1(25),
383 regulator_desc_s2mps11_ldo1(26),
384 regulator_desc_s2mps11_ldo2(27),
385 regulator_desc_s2mps11_ldo1(28),
386 regulator_desc_s2mps11_ldo1(29),
387 regulator_desc_s2mps11_ldo1(30),
388 regulator_desc_s2mps11_ldo1(31),
389 regulator_desc_s2mps11_ldo1(32),
390 regulator_desc_s2mps11_ldo1(33),
391 regulator_desc_s2mps11_ldo1(34),
392 regulator_desc_s2mps11_ldo1(35),
393 regulator_desc_s2mps11_ldo1(36),
394 regulator_desc_s2mps11_ldo1(37),
395 regulator_desc_s2mps11_ldo1(38),
396 regulator_desc_s2mps11_buck1_4(1),
397 regulator_desc_s2mps11_buck1_4(2),
398 regulator_desc_s2mps11_buck1_4(3),
399 regulator_desc_s2mps11_buck1_4(4),
400 regulator_desc_s2mps11_buck5,
401 regulator_desc_s2mps11_buck6_8(6),
402 regulator_desc_s2mps11_buck6_8(7),
403 regulator_desc_s2mps11_buck6_8(8),
404 regulator_desc_s2mps11_buck9,
405 regulator_desc_s2mps11_buck10,
408 static int s2mps14_regulator_enable(struct regulator_dev *rdev)
410 struct s2mps11_info *s2mps11 = rdev_get_drvdata(rdev);
413 if (s2mps11->s2mps14_suspend_state & (1 << rdev_get_id(rdev)))
414 val = S2MPS14_ENABLE_SUSPEND;
415 else if (s2mps11->ext_control_gpio[rdev_get_id(rdev)])
416 val = S2MPS14_ENABLE_EXT_CONTROL;
418 val = rdev->desc->enable_mask;
420 return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
421 rdev->desc->enable_mask, val);
424 static int s2mps14_regulator_set_suspend_disable(struct regulator_dev *rdev)
428 struct s2mps11_info *s2mps11 = rdev_get_drvdata(rdev);
430 /* LDO3 should be always on and does not support suspend mode */
431 if (rdev_get_id(rdev) == S2MPS14_LDO3)
434 ret = regmap_read(rdev->regmap, rdev->desc->enable_reg, &val);
438 s2mps11->s2mps14_suspend_state |= (1 << rdev_get_id(rdev));
440 * Don't enable suspend mode if regulator is already disabled because
441 * this would effectively for a short time turn on the regulator after
443 * However we still want to toggle the suspend_state bit for regulator
444 * in case if it got enabled before suspending the system.
446 if (!(val & rdev->desc->enable_mask))
449 return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
450 rdev->desc->enable_mask, S2MPS14_ENABLE_SUSPEND);
453 static struct regulator_ops s2mps14_reg_ops = {
454 .list_voltage = regulator_list_voltage_linear,
455 .map_voltage = regulator_map_voltage_linear,
456 .is_enabled = regulator_is_enabled_regmap,
457 .enable = s2mps14_regulator_enable,
458 .disable = regulator_disable_regmap,
459 .get_voltage_sel = regulator_get_voltage_sel_regmap,
460 .set_voltage_sel = regulator_set_voltage_sel_regmap,
461 .set_voltage_time_sel = regulator_set_voltage_time_sel,
462 .set_suspend_disable = s2mps14_regulator_set_suspend_disable,
465 #define regulator_desc_s2mps14_ldo1(num) { \
467 .id = S2MPS14_LDO##num, \
468 .ops = &s2mps14_reg_ops, \
469 .type = REGULATOR_VOLTAGE, \
470 .owner = THIS_MODULE, \
471 .min_uV = S2MPS14_LDO_MIN_800MV, \
472 .uV_step = S2MPS14_LDO_STEP_25MV, \
473 .n_voltages = S2MPS14_LDO_N_VOLTAGES, \
474 .vsel_reg = S2MPS14_REG_L1CTRL + num - 1, \
475 .vsel_mask = S2MPS14_LDO_VSEL_MASK, \
476 .enable_reg = S2MPS14_REG_L1CTRL + num - 1, \
477 .enable_mask = S2MPS14_ENABLE_MASK \
479 #define regulator_desc_s2mps14_ldo2(num) { \
481 .id = S2MPS14_LDO##num, \
482 .ops = &s2mps14_reg_ops, \
483 .type = REGULATOR_VOLTAGE, \
484 .owner = THIS_MODULE, \
485 .min_uV = S2MPS14_LDO_MIN_1800MV, \
486 .uV_step = S2MPS14_LDO_STEP_25MV, \
487 .n_voltages = S2MPS14_LDO_N_VOLTAGES, \
488 .vsel_reg = S2MPS14_REG_L1CTRL + num - 1, \
489 .vsel_mask = S2MPS14_LDO_VSEL_MASK, \
490 .enable_reg = S2MPS14_REG_L1CTRL + num - 1, \
491 .enable_mask = S2MPS14_ENABLE_MASK \
493 #define regulator_desc_s2mps14_ldo3(num) { \
495 .id = S2MPS14_LDO##num, \
496 .ops = &s2mps14_reg_ops, \
497 .type = REGULATOR_VOLTAGE, \
498 .owner = THIS_MODULE, \
499 .min_uV = S2MPS14_LDO_MIN_800MV, \
500 .uV_step = S2MPS14_LDO_STEP_12_5MV, \
501 .n_voltages = S2MPS14_LDO_N_VOLTAGES, \
502 .vsel_reg = S2MPS14_REG_L1CTRL + num - 1, \
503 .vsel_mask = S2MPS14_LDO_VSEL_MASK, \
504 .enable_reg = S2MPS14_REG_L1CTRL + num - 1, \
505 .enable_mask = S2MPS14_ENABLE_MASK \
507 #define regulator_desc_s2mps14_buck1235(num) { \
508 .name = "BUCK"#num, \
509 .id = S2MPS14_BUCK##num, \
510 .ops = &s2mps14_reg_ops, \
511 .type = REGULATOR_VOLTAGE, \
512 .owner = THIS_MODULE, \
513 .min_uV = S2MPS14_BUCK1235_MIN_600MV, \
514 .uV_step = S2MPS14_BUCK1235_STEP_6_25MV, \
515 .n_voltages = S2MPS14_BUCK_N_VOLTAGES, \
516 .linear_min_sel = S2MPS14_BUCK1235_START_SEL, \
517 .ramp_delay = S2MPS14_BUCK_RAMP_DELAY, \
518 .vsel_reg = S2MPS14_REG_B1CTRL2 + (num - 1) * 2, \
519 .vsel_mask = S2MPS14_BUCK_VSEL_MASK, \
520 .enable_reg = S2MPS14_REG_B1CTRL1 + (num - 1) * 2, \
521 .enable_mask = S2MPS14_ENABLE_MASK \
523 #define regulator_desc_s2mps14_buck4(num) { \
524 .name = "BUCK"#num, \
525 .id = S2MPS14_BUCK##num, \
526 .ops = &s2mps14_reg_ops, \
527 .type = REGULATOR_VOLTAGE, \
528 .owner = THIS_MODULE, \
529 .min_uV = S2MPS14_BUCK4_MIN_1400MV, \
530 .uV_step = S2MPS14_BUCK4_STEP_12_5MV, \
531 .n_voltages = S2MPS14_BUCK_N_VOLTAGES, \
532 .linear_min_sel = S2MPS14_BUCK4_START_SEL, \
533 .ramp_delay = S2MPS14_BUCK_RAMP_DELAY, \
534 .vsel_reg = S2MPS14_REG_B1CTRL2 + (num - 1) * 2, \
535 .vsel_mask = S2MPS14_BUCK_VSEL_MASK, \
536 .enable_reg = S2MPS14_REG_B1CTRL1 + (num - 1) * 2, \
537 .enable_mask = S2MPS14_ENABLE_MASK \
540 static const struct regulator_desc s2mps14_regulators[] = {
541 regulator_desc_s2mps14_ldo3(1),
542 regulator_desc_s2mps14_ldo3(2),
543 regulator_desc_s2mps14_ldo1(3),
544 regulator_desc_s2mps14_ldo1(4),
545 regulator_desc_s2mps14_ldo3(5),
546 regulator_desc_s2mps14_ldo3(6),
547 regulator_desc_s2mps14_ldo1(7),
548 regulator_desc_s2mps14_ldo2(8),
549 regulator_desc_s2mps14_ldo3(9),
550 regulator_desc_s2mps14_ldo3(10),
551 regulator_desc_s2mps14_ldo1(11),
552 regulator_desc_s2mps14_ldo2(12),
553 regulator_desc_s2mps14_ldo2(13),
554 regulator_desc_s2mps14_ldo2(14),
555 regulator_desc_s2mps14_ldo2(15),
556 regulator_desc_s2mps14_ldo2(16),
557 regulator_desc_s2mps14_ldo2(17),
558 regulator_desc_s2mps14_ldo2(18),
559 regulator_desc_s2mps14_ldo1(19),
560 regulator_desc_s2mps14_ldo1(20),
561 regulator_desc_s2mps14_ldo1(21),
562 regulator_desc_s2mps14_ldo3(22),
563 regulator_desc_s2mps14_ldo1(23),
564 regulator_desc_s2mps14_ldo2(24),
565 regulator_desc_s2mps14_ldo2(25),
566 regulator_desc_s2mps14_buck1235(1),
567 regulator_desc_s2mps14_buck1235(2),
568 regulator_desc_s2mps14_buck1235(3),
569 regulator_desc_s2mps14_buck4(4),
570 regulator_desc_s2mps14_buck1235(5),
573 static int s2mps14_pmic_enable_ext_control(struct s2mps11_info *s2mps11,
574 struct regulator_dev *rdev)
576 return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
577 rdev->desc->enable_mask, S2MPS14_ENABLE_EXT_CONTROL);
580 static void s2mps14_pmic_dt_parse_ext_control_gpio(struct platform_device *pdev,
581 struct of_regulator_match *rdata, struct s2mps11_info *s2mps11)
583 int *gpio = s2mps11->ext_control_gpio;
585 unsigned int valid_regulators[3] = { S2MPS14_LDO10, S2MPS14_LDO11,
588 for (i = 0; i < ARRAY_SIZE(valid_regulators); i++) {
589 unsigned int reg = valid_regulators[i];
591 if (!rdata[reg].init_data || !rdata[reg].of_node)
594 gpio[reg] = of_get_named_gpio(rdata[reg].of_node,
595 "samsung,ext-control-gpios", 0);
596 if (!gpio_is_valid(gpio[reg]))
599 dev_dbg(&pdev->dev, "Using GPIO %d for ext-control over %d/%s\n",
600 gpio[reg], reg, rdata[reg].name);
604 static int s2mps11_pmic_dt_parse(struct platform_device *pdev,
605 struct of_regulator_match *rdata, struct s2mps11_info *s2mps11,
606 enum sec_device_type dev_type)
608 struct device_node *reg_np;
610 reg_np = of_get_child_by_name(pdev->dev.parent->of_node, "regulators");
612 dev_err(&pdev->dev, "could not find regulators sub-node\n");
616 of_regulator_match(&pdev->dev, reg_np, rdata, s2mps11->rdev_num);
617 if (dev_type == S2MPS14X)
618 s2mps14_pmic_dt_parse_ext_control_gpio(pdev, rdata, s2mps11);
625 static int s2mps11_pmic_probe(struct platform_device *pdev)
627 struct sec_pmic_dev *iodev = dev_get_drvdata(pdev->dev.parent);
628 struct sec_platform_data *pdata = NULL;
629 struct of_regulator_match *rdata = NULL;
630 struct regulator_config config = { };
631 struct s2mps11_info *s2mps11;
633 const struct regulator_desc *regulators;
634 enum sec_device_type dev_type;
636 s2mps11 = devm_kzalloc(&pdev->dev, sizeof(struct s2mps11_info),
641 dev_type = platform_get_device_id(pdev)->driver_data;
644 s2mps11->rdev_num = ARRAY_SIZE(s2mps11_regulators);
645 regulators = s2mps11_regulators;
648 s2mps11->rdev_num = ARRAY_SIZE(s2mps14_regulators);
649 regulators = s2mps14_regulators;
652 dev_err(&pdev->dev, "Invalid device type: %u\n", dev_type);
656 s2mps11->ext_control_gpio = devm_kzalloc(&pdev->dev,
657 sizeof(*s2mps11->ext_control_gpio) * s2mps11->rdev_num,
659 if (!s2mps11->ext_control_gpio)
662 if (!iodev->dev->of_node) {
664 pdata = iodev->pdata;
667 dev_err(pdev->dev.parent,
668 "Platform data or DT node not supplied\n");
673 rdata = kzalloc(sizeof(*rdata) * s2mps11->rdev_num, GFP_KERNEL);
677 for (i = 0; i < s2mps11->rdev_num; i++)
678 rdata[i].name = regulators[i].name;
680 ret = s2mps11_pmic_dt_parse(pdev, rdata, s2mps11, dev_type);
685 platform_set_drvdata(pdev, s2mps11);
687 config.dev = &pdev->dev;
688 config.regmap = iodev->regmap_pmic;
689 config.driver_data = s2mps11;
690 for (i = 0; i < s2mps11->rdev_num; i++) {
691 struct regulator_dev *regulator;
694 config.init_data = pdata->regulators[i].initdata;
695 config.of_node = pdata->regulators[i].reg_node;
697 config.init_data = rdata[i].init_data;
698 config.of_node = rdata[i].of_node;
701 if (s2mps11->ext_control_gpio[i]) {
702 config.ena_gpio = s2mps11->ext_control_gpio[i];
703 config.ena_gpio_flags = GPIOF_OUT_INIT_HIGH;
705 config.ena_gpio = config.ena_gpio_flags = 0;
707 regulator = devm_regulator_register(&pdev->dev,
708 ®ulators[i], &config);
709 if (IS_ERR(regulator)) {
710 ret = PTR_ERR(regulator);
711 dev_err(&pdev->dev, "regulator init failed for %d\n",
716 if (s2mps11->ext_control_gpio[i]) {
717 ret = s2mps14_pmic_enable_ext_control(s2mps11,
721 "failed to enable GPIO control over %s: %d\n",
722 regulator->desc->name, ret);
734 static const struct platform_device_id s2mps11_pmic_id[] = {
735 { "s2mps11-pmic", S2MPS11X},
736 { "s2mps14-pmic", S2MPS14X},
739 MODULE_DEVICE_TABLE(platform, s2mps11_pmic_id);
741 static struct platform_driver s2mps11_pmic_driver = {
743 .name = "s2mps11-pmic",
744 .owner = THIS_MODULE,
746 .probe = s2mps11_pmic_probe,
747 .id_table = s2mps11_pmic_id,
750 static int __init s2mps11_pmic_init(void)
752 return platform_driver_register(&s2mps11_pmic_driver);
754 subsys_initcall(s2mps11_pmic_init);
756 static void __exit s2mps11_pmic_exit(void)
758 platform_driver_unregister(&s2mps11_pmic_driver);
760 module_exit(s2mps11_pmic_exit);
762 /* Module information */
763 MODULE_AUTHOR("Sangbeom Kim <sbkim73@samsung.com>");
764 MODULE_DESCRIPTION("SAMSUNG S2MPS11/S2MPS14 Regulator Driver");
765 MODULE_LICENSE("GPL");