regulator: max77802: Don't ignore return value of current opmode
[cascardo/linux.git] / drivers / regulator / max77802.c
1 /*
2  * max77802.c - Regulator driver for the Maxim 77802
3  *
4  * Copyright (C) 2013-2014 Google, Inc
5  * Simon Glass <sjg@chromium.org>
6  *
7  * Copyright (C) 2012 Samsung Electronics
8  * Chiwoong Byun <woong.byun@smasung.com>
9  * Jonghwa Lee <jonghwa3.lee@samsung.com>
10  *
11  * This program is free software; you can redistribute it and/or modify
12  * it under the terms of the GNU General Public License as published by
13  * the Free Software Foundation; either version 2 of the License, or
14  * (at your option) any later version.
15  *
16  * This program is distributed in the hope that it will be useful,
17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19  * GNU General Public License for more details.
20  *
21  * This driver is based on max8997.c
22  */
23
24 #include <linux/kernel.h>
25 #include <linux/bug.h>
26 #include <linux/err.h>
27 #include <linux/gpio.h>
28 #include <linux/slab.h>
29 #include <linux/gpio/consumer.h>
30 #include <linux/platform_device.h>
31 #include <linux/regulator/driver.h>
32 #include <linux/regulator/machine.h>
33 #include <linux/regulator/of_regulator.h>
34 #include <linux/mfd/max77686.h>
35 #include <linux/mfd/max77686-private.h>
36 #include <dt-bindings/regulator/maxim,max77802.h>
37
38 /* Default ramp delay in case it is not manually set */
39 #define MAX77802_RAMP_DELAY             100000          /* uV/us */
40
41 #define MAX77802_OPMODE_SHIFT_LDO       6
42 #define MAX77802_OPMODE_BUCK234_SHIFT   4
43 #define MAX77802_OPMODE_MASK            0x3
44
45 #define MAX77802_VSEL_MASK              0x3F
46 #define MAX77802_DVS_VSEL_MASK          0xFF
47
48 #define MAX77802_RAMP_RATE_MASK_2BIT    0xC0
49 #define MAX77802_RAMP_RATE_SHIFT_2BIT   6
50 #define MAX77802_RAMP_RATE_MASK_4BIT    0xF0
51 #define MAX77802_RAMP_RATE_SHIFT_4BIT   4
52
53 #define MAX77802_STATUS_OFF             0x0
54 #define MAX77802_OFF_PWRREQ             0x1
55 #define MAX77802_LP_PWRREQ              0x2
56
57 /* MAX77802 has two register formats: 2-bit and 4-bit */
58 static const unsigned int ramp_table_77802_2bit[] = {
59         12500,
60         25000,
61         50000,
62         100000,
63 };
64
65 static unsigned int ramp_table_77802_4bit[] = {
66         1000,   2000,   3030,   4000,
67         5000,   5880,   7140,   8330,
68         9090,   10000,  11110,  12500,
69         16670,  25000,  50000,  100000,
70 };
71
72 struct max77802_regulator_prv {
73         unsigned int opmode[MAX77802_REG_MAX];
74 };
75
76 static inline unsigned int max77802_map_mode(unsigned int mode)
77 {
78         return mode == MAX77802_OPMODE_NORMAL ?
79                 REGULATOR_MODE_NORMAL : REGULATOR_MODE_STANDBY;
80 }
81
82 static int max77802_get_opmode_shift(int id)
83 {
84         if (id == MAX77802_BUCK1 || (id >= MAX77802_BUCK5 &&
85                                      id <= MAX77802_BUCK10))
86                 return 0;
87
88         if (id >= MAX77802_BUCK2 && id <= MAX77802_BUCK4)
89                 return MAX77802_OPMODE_BUCK234_SHIFT;
90
91         if (id >= MAX77802_LDO1 && id <= MAX77802_LDO35)
92                 return MAX77802_OPMODE_SHIFT_LDO;
93
94         return -EINVAL;
95 }
96
97 /**
98  * max77802_set_suspend_disable - Disable the regulator during system suspend
99  * @rdev: regulator to mark as disabled
100  *
101  * All regulators expect LDO 1, 3, 20 and 21 support OFF by PWRREQ.
102  * Configure the regulator so the PMIC will turn it OFF during system suspend.
103  */
104 static int max77802_set_suspend_disable(struct regulator_dev *rdev)
105 {
106         unsigned int val = MAX77802_OFF_PWRREQ;
107         struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
108         int id = rdev_get_id(rdev);
109         int shift = max77802_get_opmode_shift(id);
110
111         max77802->opmode[id] = val;
112         return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
113                                   rdev->desc->enable_mask, val << shift);
114 }
115
116 /*
117  * Some LDOs support Low Power Mode while the system is running.
118  *
119  * LDOs 1, 3, 20, 21.
120  */
121 static int max77802_set_mode(struct regulator_dev *rdev, unsigned int mode)
122 {
123         struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
124         int id = rdev_get_id(rdev);
125         unsigned int val;
126         int shift = max77802_get_opmode_shift(id);
127
128         switch (mode) {
129         case REGULATOR_MODE_STANDBY:
130                 val = MAX77802_OPMODE_LP;       /* ON in Low Power Mode */
131                 break;
132         case REGULATOR_MODE_NORMAL:
133                 val = MAX77802_OPMODE_NORMAL;   /* ON in Normal Mode */
134                 break;
135         default:
136                 dev_warn(&rdev->dev, "%s: regulator mode: 0x%x not supported\n",
137                          rdev->desc->name, mode);
138                 return -EINVAL;
139         }
140
141         max77802->opmode[id] = val;
142         return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
143                                   rdev->desc->enable_mask, val << shift);
144 }
145
146 static unsigned max77802_get_mode(struct regulator_dev *rdev)
147 {
148         struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
149         int id = rdev_get_id(rdev);
150
151         return max77802_map_mode(max77802->opmode[id]);
152 }
153
154 /**
155  * max77802_set_suspend_mode - set regulator opmode when the system is suspended
156  * @rdev: regulator to change mode
157  * @mode: operating mode to be set
158  *
159  * Will set the operating mode for the regulators during system suspend.
160  * This function is valid for the three different enable control logics:
161  *
162  * Enable Control Logic1 by PWRREQ (BUCK 2-4 and LDOs 2, 4-19, 22-35)
163  * Enable Control Logic2 by PWRREQ (LDOs 1, 20, 21)
164  * Enable Control Logic3 by PWRREQ (LDO 3)
165  *
166  * If setting the regulator mode fails, the function only warns but does
167  * not return an error code to avoid the regulator core to stop setting
168  * the operating mode for the remaining regulators.
169  */
170 static int max77802_set_suspend_mode(struct regulator_dev *rdev,
171                                      unsigned int mode)
172 {
173         struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
174         int id = rdev_get_id(rdev);
175         unsigned int val;
176         int shift = max77802_get_opmode_shift(id);
177
178         /*
179          * If the regulator has been disabled for suspend
180          * then is invalid to try setting a suspend mode.
181          */
182         if (max77802->opmode[id] == MAX77802_OFF_PWRREQ) {
183                 dev_warn(&rdev->dev, "%s: is disabled, mode: 0x%x not set\n",
184                          rdev->desc->name, mode);
185                 return 0;
186         }
187
188         switch (mode) {
189         case REGULATOR_MODE_STANDBY:
190                 /*
191                  * If the regulator opmode is normal then enable
192                  * ON in Low Power Mode by PWRREQ. If the mode is
193                  * already Low Power then no action is required.
194                  */
195                 if (max77802->opmode[id] == MAX77802_OPMODE_NORMAL)
196                         val = MAX77802_LP_PWRREQ;
197                 else
198                         return 0;
199                 break;
200         case REGULATOR_MODE_NORMAL:
201                 /*
202                  * If the regulator operating mode is Low Power then
203                  * normal is not a valid opmode in suspend. If the
204                  * mode is already normal then no action is required.
205                  */
206                 if (max77802->opmode[id] == MAX77802_OPMODE_LP)
207                         dev_warn(&rdev->dev, "%s: in Low Power: 0x%x invalid\n",
208                                  rdev->desc->name, mode);
209                 return 0;
210         default:
211                 dev_warn(&rdev->dev, "%s: regulator mode: 0x%x not supported\n",
212                          rdev->desc->name, mode);
213                 return -EINVAL;
214         }
215
216         return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
217                                   rdev->desc->enable_mask, val << shift);
218 }
219
220 static int max77802_enable(struct regulator_dev *rdev)
221 {
222         struct max77802_regulator_prv *max77802 = rdev_get_drvdata(rdev);
223         int id = rdev_get_id(rdev);
224         int shift = max77802_get_opmode_shift(id);
225
226         if (max77802->opmode[id] == MAX77802_OFF_PWRREQ)
227                 max77802->opmode[id] = MAX77802_OPMODE_NORMAL;
228
229         return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
230                                   rdev->desc->enable_mask,
231                                   max77802->opmode[id] << shift);
232 }
233
234 static int max77802_find_ramp_value(struct regulator_dev *rdev,
235                                     const unsigned int limits[], int size,
236                                     unsigned int ramp_delay)
237 {
238         int i;
239
240         for (i = 0; i < size; i++) {
241                 if (ramp_delay <= limits[i])
242                         return i;
243         }
244
245         /* Use maximum value for no ramp control */
246         dev_warn(&rdev->dev, "%s: ramp_delay: %d not supported, setting 100000\n",
247                  rdev->desc->name, ramp_delay);
248         return size - 1;
249 }
250
251 /* Used for BUCKs 2-4 */
252 static int max77802_set_ramp_delay_2bit(struct regulator_dev *rdev,
253                                         int ramp_delay)
254 {
255         int id = rdev_get_id(rdev);
256         unsigned int ramp_value;
257
258         if (id > MAX77802_BUCK4) {
259                         dev_warn(&rdev->dev,
260                                  "%s: regulator: ramp delay not supported\n",
261                                  rdev->desc->name);
262                 return -EINVAL;
263         }
264         ramp_value = max77802_find_ramp_value(rdev, ramp_table_77802_2bit,
265                                 ARRAY_SIZE(ramp_table_77802_2bit), ramp_delay);
266
267         return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
268                                   MAX77802_RAMP_RATE_MASK_2BIT,
269                                   ramp_value << MAX77802_RAMP_RATE_SHIFT_2BIT);
270 }
271
272 /* For BUCK1, 6 */
273 static int max77802_set_ramp_delay_4bit(struct regulator_dev *rdev,
274                                             int ramp_delay)
275 {
276         unsigned int ramp_value;
277
278         ramp_value = max77802_find_ramp_value(rdev, ramp_table_77802_4bit,
279                                 ARRAY_SIZE(ramp_table_77802_4bit), ramp_delay);
280
281         return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg,
282                                   MAX77802_RAMP_RATE_MASK_4BIT,
283                                   ramp_value << MAX77802_RAMP_RATE_SHIFT_4BIT);
284 }
285
286 /*
287  * LDOs 2, 4-19, 22-35
288  */
289 static struct regulator_ops max77802_ldo_ops_logic1 = {
290         .list_voltage           = regulator_list_voltage_linear,
291         .map_voltage            = regulator_map_voltage_linear,
292         .is_enabled             = regulator_is_enabled_regmap,
293         .enable                 = max77802_enable,
294         .disable                = regulator_disable_regmap,
295         .get_voltage_sel        = regulator_get_voltage_sel_regmap,
296         .set_voltage_sel        = regulator_set_voltage_sel_regmap,
297         .set_voltage_time_sel   = regulator_set_voltage_time_sel,
298         .set_suspend_disable    = max77802_set_suspend_disable,
299         .set_suspend_mode       = max77802_set_suspend_mode,
300 };
301
302 /*
303  * LDOs 1, 20, 21, 3
304  */
305 static struct regulator_ops max77802_ldo_ops_logic2 = {
306         .list_voltage           = regulator_list_voltage_linear,
307         .map_voltage            = regulator_map_voltage_linear,
308         .is_enabled             = regulator_is_enabled_regmap,
309         .enable                 = max77802_enable,
310         .disable                = regulator_disable_regmap,
311         .get_voltage_sel        = regulator_get_voltage_sel_regmap,
312         .set_voltage_sel        = regulator_set_voltage_sel_regmap,
313         .set_voltage_time_sel   = regulator_set_voltage_time_sel,
314         .set_mode               = max77802_set_mode,
315         .get_mode               = max77802_get_mode,
316         .set_suspend_mode       = max77802_set_suspend_mode,
317 };
318
319 /* BUCKS 1, 6 */
320 static struct regulator_ops max77802_buck_16_dvs_ops = {
321         .list_voltage           = regulator_list_voltage_linear,
322         .map_voltage            = regulator_map_voltage_linear,
323         .is_enabled             = regulator_is_enabled_regmap,
324         .enable                 = max77802_enable,
325         .disable                = regulator_disable_regmap,
326         .get_voltage_sel        = regulator_get_voltage_sel_regmap,
327         .set_voltage_sel        = regulator_set_voltage_sel_regmap,
328         .set_voltage_time_sel   = regulator_set_voltage_time_sel,
329         .set_ramp_delay         = max77802_set_ramp_delay_4bit,
330         .set_suspend_disable    = max77802_set_suspend_disable,
331 };
332
333 /* BUCKs 2-4 */
334 static struct regulator_ops max77802_buck_234_ops = {
335         .list_voltage           = regulator_list_voltage_linear,
336         .map_voltage            = regulator_map_voltage_linear,
337         .is_enabled             = regulator_is_enabled_regmap,
338         .enable                 = max77802_enable,
339         .disable                = regulator_disable_regmap,
340         .get_voltage_sel        = regulator_get_voltage_sel_regmap,
341         .set_voltage_sel        = regulator_set_voltage_sel_regmap,
342         .set_voltage_time_sel   = regulator_set_voltage_time_sel,
343         .set_ramp_delay         = max77802_set_ramp_delay_2bit,
344         .set_suspend_disable    = max77802_set_suspend_disable,
345         .set_suspend_mode       = max77802_set_suspend_mode,
346 };
347
348 /* BUCKs 5, 7-10 */
349 static struct regulator_ops max77802_buck_dvs_ops = {
350         .list_voltage           = regulator_list_voltage_linear,
351         .map_voltage            = regulator_map_voltage_linear,
352         .is_enabled             = regulator_is_enabled_regmap,
353         .enable                 = max77802_enable,
354         .disable                = regulator_disable_regmap,
355         .get_voltage_sel        = regulator_get_voltage_sel_regmap,
356         .set_voltage_sel        = regulator_set_voltage_sel_regmap,
357         .set_voltage_time_sel   = regulator_set_voltage_time_sel,
358         .set_ramp_delay         = max77802_set_ramp_delay_2bit,
359         .set_suspend_disable    = max77802_set_suspend_disable,
360 };
361
362 /* LDOs 3-7, 9-14, 18-26, 28, 29, 32-34 */
363 #define regulator_77802_desc_p_ldo(num, supply, log)    {               \
364         .name           = "LDO"#num,                                    \
365         .id             = MAX77802_LDO##num,                            \
366         .supply_name    = "inl"#supply,                                 \
367         .ops            = &max77802_ldo_ops_logic##log,                 \
368         .type           = REGULATOR_VOLTAGE,                            \
369         .owner          = THIS_MODULE,                                  \
370         .min_uV         = 800000,                                       \
371         .uV_step        = 50000,                                        \
372         .ramp_delay     = MAX77802_RAMP_DELAY,                          \
373         .n_voltages     = 1 << 6,                                       \
374         .vsel_reg       = MAX77802_REG_LDO1CTRL1 + num - 1,             \
375         .vsel_mask      = MAX77802_VSEL_MASK,                           \
376         .enable_reg     = MAX77802_REG_LDO1CTRL1 + num - 1,             \
377         .enable_mask    = MAX77802_OPMODE_MASK << MAX77802_OPMODE_SHIFT_LDO, \
378 }
379
380 /* LDOs 1, 2, 8, 15, 17, 27, 30, 35 */
381 #define regulator_77802_desc_n_ldo(num, supply, log)   {                \
382         .name           = "LDO"#num,                                    \
383         .id             = MAX77802_LDO##num,                            \
384         .supply_name    = "inl"#supply,                                 \
385         .ops            = &max77802_ldo_ops_logic##log,                 \
386         .type           = REGULATOR_VOLTAGE,                            \
387         .owner          = THIS_MODULE,                                  \
388         .min_uV         = 800000,                                       \
389         .uV_step        = 25000,                                        \
390         .ramp_delay     = MAX77802_RAMP_DELAY,                          \
391         .n_voltages     = 1 << 6,                                       \
392         .vsel_reg       = MAX77802_REG_LDO1CTRL1 + num - 1,             \
393         .vsel_mask      = MAX77802_VSEL_MASK,                           \
394         .enable_reg     = MAX77802_REG_LDO1CTRL1 + num - 1,             \
395         .enable_mask    = MAX77802_OPMODE_MASK << MAX77802_OPMODE_SHIFT_LDO, \
396 }
397
398 /* BUCKs 1, 6 */
399 #define regulator_77802_desc_16_buck(num)       {               \
400         .name           = "BUCK"#num,                                   \
401         .id             = MAX77802_BUCK##num,                           \
402         .supply_name    = "inb"#num,                                    \
403         .ops            = &max77802_buck_16_dvs_ops,                    \
404         .type           = REGULATOR_VOLTAGE,                            \
405         .owner          = THIS_MODULE,                                  \
406         .min_uV         = 612500,                                       \
407         .uV_step        = 6250,                                         \
408         .ramp_delay     = MAX77802_RAMP_DELAY,                          \
409         .n_voltages     = 1 << 8,                                       \
410         .vsel_reg       = MAX77802_REG_BUCK ## num ## DVS1,             \
411         .vsel_mask      = MAX77802_DVS_VSEL_MASK,                       \
412         .enable_reg     = MAX77802_REG_BUCK ## num ## CTRL,             \
413         .enable_mask    = MAX77802_OPMODE_MASK,                         \
414 }
415
416 /* BUCKS 2-4 */
417 #define regulator_77802_desc_234_buck(num)      {               \
418         .name           = "BUCK"#num,                                   \
419         .id             = MAX77802_BUCK##num,                           \
420         .supply_name    = "inb"#num,                                    \
421         .ops            = &max77802_buck_234_ops,                       \
422         .type           = REGULATOR_VOLTAGE,                            \
423         .owner          = THIS_MODULE,                                  \
424         .min_uV         = 600000,                                       \
425         .uV_step        = 6250,                                         \
426         .ramp_delay     = MAX77802_RAMP_DELAY,                          \
427         .n_voltages     = 0x91,                                         \
428         .vsel_reg       = MAX77802_REG_BUCK ## num ## DVS1,             \
429         .vsel_mask      = MAX77802_DVS_VSEL_MASK,                       \
430         .enable_reg     = MAX77802_REG_BUCK ## num ## CTRL1,            \
431         .enable_mask    = MAX77802_OPMODE_MASK <<                       \
432                                 MAX77802_OPMODE_BUCK234_SHIFT,          \
433 }
434
435 /* BUCK 5 */
436 #define regulator_77802_desc_buck5(num)         {               \
437         .name           = "BUCK"#num,                                   \
438         .id             = MAX77802_BUCK##num,                           \
439         .supply_name    = "inb"#num,                                    \
440         .ops            = &max77802_buck_dvs_ops,                       \
441         .type           = REGULATOR_VOLTAGE,                            \
442         .owner          = THIS_MODULE,                                  \
443         .min_uV         = 750000,                                       \
444         .uV_step        = 50000,                                        \
445         .ramp_delay     = MAX77802_RAMP_DELAY,                          \
446         .n_voltages     = 1 << 6,                                       \
447         .vsel_reg       = MAX77802_REG_BUCK5OUT,                        \
448         .vsel_mask      = MAX77802_VSEL_MASK,                           \
449         .enable_reg     = MAX77802_REG_BUCK5CTRL,                       \
450         .enable_mask    = MAX77802_OPMODE_MASK,                         \
451 }
452
453 /* BUCKs 7-10 */
454 #define regulator_77802_desc_buck7_10(num)      {               \
455         .name           = "BUCK"#num,                                   \
456         .id             = MAX77802_BUCK##num,                           \
457         .supply_name    = "inb"#num,                                    \
458         .ops            = &max77802_buck_dvs_ops,                       \
459         .type           = REGULATOR_VOLTAGE,                            \
460         .owner          = THIS_MODULE,                                  \
461         .min_uV         = 750000,                                       \
462         .uV_step        = 50000,                                        \
463         .ramp_delay     = MAX77802_RAMP_DELAY,                          \
464         .n_voltages     = 1 << 6,                                       \
465         .vsel_reg       = MAX77802_REG_BUCK7OUT + (num - 7) * 3,        \
466         .vsel_mask      = MAX77802_VSEL_MASK,                           \
467         .enable_reg     = MAX77802_REG_BUCK7CTRL + (num - 7) * 3,       \
468         .enable_mask    = MAX77802_OPMODE_MASK,                         \
469 }
470
471 static const struct regulator_desc regulators[] = {
472         regulator_77802_desc_16_buck(1),
473         regulator_77802_desc_234_buck(2),
474         regulator_77802_desc_234_buck(3),
475         regulator_77802_desc_234_buck(4),
476         regulator_77802_desc_buck5(5),
477         regulator_77802_desc_16_buck(6),
478         regulator_77802_desc_buck7_10(7),
479         regulator_77802_desc_buck7_10(8),
480         regulator_77802_desc_buck7_10(9),
481         regulator_77802_desc_buck7_10(10),
482         regulator_77802_desc_n_ldo(1, 10, 2),
483         regulator_77802_desc_n_ldo(2, 10, 1),
484         regulator_77802_desc_p_ldo(3, 3, 2),
485         regulator_77802_desc_p_ldo(4, 6, 1),
486         regulator_77802_desc_p_ldo(5, 3, 1),
487         regulator_77802_desc_p_ldo(6, 3, 1),
488         regulator_77802_desc_p_ldo(7, 3, 1),
489         regulator_77802_desc_n_ldo(8, 1, 1),
490         regulator_77802_desc_p_ldo(9, 5, 1),
491         regulator_77802_desc_p_ldo(10, 4, 1),
492         regulator_77802_desc_p_ldo(11, 4, 1),
493         regulator_77802_desc_p_ldo(12, 9, 1),
494         regulator_77802_desc_p_ldo(13, 4, 1),
495         regulator_77802_desc_p_ldo(14, 4, 1),
496         regulator_77802_desc_n_ldo(15, 1, 1),
497         regulator_77802_desc_n_ldo(17, 2, 1),
498         regulator_77802_desc_p_ldo(18, 7, 1),
499         regulator_77802_desc_p_ldo(19, 5, 1),
500         regulator_77802_desc_p_ldo(20, 7, 2),
501         regulator_77802_desc_p_ldo(21, 6, 2),
502         regulator_77802_desc_p_ldo(23, 9, 1),
503         regulator_77802_desc_p_ldo(24, 6, 1),
504         regulator_77802_desc_p_ldo(25, 9, 1),
505         regulator_77802_desc_p_ldo(26, 9, 1),
506         regulator_77802_desc_n_ldo(27, 2, 1),
507         regulator_77802_desc_p_ldo(28, 7, 1),
508         regulator_77802_desc_p_ldo(29, 7, 1),
509         regulator_77802_desc_n_ldo(30, 2, 1),
510         regulator_77802_desc_p_ldo(32, 9, 1),
511         regulator_77802_desc_p_ldo(33, 6, 1),
512         regulator_77802_desc_p_ldo(34, 9, 1),
513         regulator_77802_desc_n_ldo(35, 2, 1),
514 };
515
516 #ifdef CONFIG_OF
517 static int max77802_pmic_dt_parse_pdata(struct platform_device *pdev,
518                                         struct max77686_platform_data *pdata)
519 {
520         struct max77686_dev *iodev = dev_get_drvdata(pdev->dev.parent);
521         struct device_node *pmic_np, *regulators_np;
522         struct max77686_regulator_data *rdata;
523         struct of_regulator_match rmatch;
524         unsigned int i;
525
526         pmic_np = iodev->dev->of_node;
527         regulators_np = of_get_child_by_name(pmic_np, "regulators");
528         if (!regulators_np) {
529                 dev_err(&pdev->dev, "could not find regulators sub-node\n");
530                 return -EINVAL;
531         }
532
533         pdata->num_regulators = ARRAY_SIZE(regulators);
534         rdata = devm_kzalloc(&pdev->dev, sizeof(*rdata) *
535                              pdata->num_regulators, GFP_KERNEL);
536         if (!rdata) {
537                 of_node_put(regulators_np);
538                 return -ENOMEM;
539         }
540
541         for (i = 0; i < pdata->num_regulators; i++) {
542                 rmatch.name = regulators[i].name;
543                 rmatch.init_data = NULL;
544                 rmatch.of_node = NULL;
545                 if (of_regulator_match(&pdev->dev, regulators_np, &rmatch,
546                                        1) != 1) {
547                         dev_warn(&pdev->dev, "No matching regulator for '%s'\n",
548                                  rmatch.name);
549                         continue;
550                 }
551                 rdata[i].initdata = rmatch.init_data;
552                 rdata[i].of_node = rmatch.of_node;
553                 rdata[i].id = regulators[i].id;
554         }
555
556         pdata->regulators = rdata;
557         of_node_put(regulators_np);
558
559         return 0;
560 }
561 #else
562 static int max77802_pmic_dt_parse_pdata(struct platform_device *pdev,
563                                         struct max77686_platform_data *pdata)
564 {
565         return 0;
566 }
567 #endif /* CONFIG_OF */
568
569 static int max77802_pmic_probe(struct platform_device *pdev)
570 {
571         struct max77686_dev *iodev = dev_get_drvdata(pdev->dev.parent);
572         struct max77686_platform_data *pdata = dev_get_platdata(iodev->dev);
573         struct max77802_regulator_prv *max77802;
574         int i, ret = 0, val;
575         struct regulator_config config = { };
576
577         /* This is allocated by the MFD driver */
578         if (!pdata) {
579                 dev_err(&pdev->dev, "no platform data found for regulator\n");
580                 return -ENODEV;
581         }
582
583         max77802 = devm_kzalloc(&pdev->dev,
584                                 sizeof(struct max77802_regulator_prv),
585                                 GFP_KERNEL);
586         if (!max77802)
587                 return -ENOMEM;
588
589         if (iodev->dev->of_node) {
590                 ret = max77802_pmic_dt_parse_pdata(pdev, pdata);
591                 if (ret)
592                         return ret;
593         }
594
595         config.dev = iodev->dev;
596         config.regmap = iodev->regmap;
597         config.driver_data = max77802;
598         platform_set_drvdata(pdev, max77802);
599
600         for (i = 0; i < MAX77802_REG_MAX; i++) {
601                 struct regulator_dev *rdev;
602                 int id = pdata->regulators[i].id;
603                 int shift = max77802_get_opmode_shift(id);
604
605                 config.init_data = pdata->regulators[i].initdata;
606                 config.of_node = pdata->regulators[i].of_node;
607
608                 ret = regmap_read(iodev->regmap, regulators[i].enable_reg, &val);
609                 if (ret < 0) {
610                         dev_warn(&pdev->dev,
611                                 "cannot read current mode for %d\n", i);
612                         val = MAX77802_OPMODE_NORMAL;
613                 } else {
614                         val = val >> shift & MAX77802_OPMODE_MASK;
615                 }
616
617                 /*
618                  * If the regulator is disabled and the system warm rebooted,
619                  * the hardware reports OFF as the regulator operating mode.
620                  * Default to operating mode NORMAL in that case.
621                  */
622                 if (val == MAX77802_STATUS_OFF)
623                         max77802->opmode[id] = MAX77802_OPMODE_NORMAL;
624                 else
625                         max77802->opmode[id] = val;
626
627                 rdev = devm_regulator_register(&pdev->dev,
628                                                &regulators[i], &config);
629                 if (IS_ERR(rdev)) {
630                         dev_err(&pdev->dev,
631                                 "regulator init failed for %d\n", i);
632                         return PTR_ERR(rdev);
633                 }
634         }
635
636         return 0;
637 }
638
639 static const struct platform_device_id max77802_pmic_id[] = {
640         {"max77802-pmic", 0},
641         { },
642 };
643 MODULE_DEVICE_TABLE(platform, max77802_pmic_id);
644
645 static struct platform_driver max77802_pmic_driver = {
646         .driver = {
647                 .name = "max77802-pmic",
648                 .owner = THIS_MODULE,
649         },
650         .probe = max77802_pmic_probe,
651         .id_table = max77802_pmic_id,
652 };
653
654 module_platform_driver(max77802_pmic_driver);
655
656 MODULE_DESCRIPTION("MAXIM 77802 Regulator Driver");
657 MODULE_AUTHOR("Simon Glass <sjg@chromium.org>");
658 MODULE_LICENSE("GPL");