mm: thp: set the accessed flag for old pages on access fault
[pandora-kernel.git] / drivers / regulator / max8997.c
1 /*
2  * max8997.c - Regulator driver for the Maxim 8997/8966
3  *
4  * Copyright (C) 2011 Samsung Electronics
5  * MyungJoo Ham <myungjoo.ham@smasung.com>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
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.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
20  *
21  * This driver is based on max8998.c
22  */
23
24 #include <linux/bug.h>
25 #include <linux/delay.h>
26 #include <linux/err.h>
27 #include <linux/gpio.h>
28 #include <linux/slab.h>
29 #include <linux/module.h>
30 #include <linux/platform_device.h>
31 #include <linux/regulator/driver.h>
32 #include <linux/regulator/machine.h>
33 #include <linux/mfd/max8997.h>
34 #include <linux/mfd/max8997-private.h>
35
36 struct max8997_data {
37         struct device *dev;
38         struct max8997_dev *iodev;
39         int num_regulators;
40         struct regulator_dev **rdev;
41         int ramp_delay; /* in mV/us */
42
43         bool buck1_gpiodvs;
44         bool buck2_gpiodvs;
45         bool buck5_gpiodvs;
46         u8 buck1_vol[8];
47         u8 buck2_vol[8];
48         u8 buck5_vol[8];
49         int buck125_gpios[3];
50         int buck125_gpioindex;
51         bool ignore_gpiodvs_side_effect;
52
53         u8 saved_states[MAX8997_REG_MAX];
54 };
55
56 static inline void max8997_set_gpio(struct max8997_data *max8997)
57 {
58         int set3 = (max8997->buck125_gpioindex) & 0x1;
59         int set2 = ((max8997->buck125_gpioindex) >> 1) & 0x1;
60         int set1 = ((max8997->buck125_gpioindex) >> 2) & 0x1;
61
62         gpio_set_value(max8997->buck125_gpios[0], set1);
63         gpio_set_value(max8997->buck125_gpios[1], set2);
64         gpio_set_value(max8997->buck125_gpios[2], set3);
65 }
66
67 struct voltage_map_desc {
68         int min;
69         int max;
70         int step;
71         unsigned int n_bits;
72 };
73
74 /* Voltage maps in uV */
75 static const struct voltage_map_desc ldo_voltage_map_desc = {
76         .min = 800000,  .max = 3950000, .step = 50000,  .n_bits = 6,
77 }; /* LDO1 ~ 18, 21 all */
78
79 static const struct voltage_map_desc buck1245_voltage_map_desc = {
80         .min = 650000,  .max = 2225000, .step = 25000,  .n_bits = 6,
81 }; /* Buck1, 2, 4, 5 */
82
83 static const struct voltage_map_desc buck37_voltage_map_desc = {
84         .min = 750000,  .max = 3900000, .step = 50000,  .n_bits = 6,
85 }; /* Buck3, 7 */
86
87 /* current map in uA */
88 static const struct voltage_map_desc charger_current_map_desc = {
89         .min = 200000,  .max = 950000,  .step = 50000,  .n_bits = 4,
90 };
91
92 static const struct voltage_map_desc topoff_current_map_desc = {
93         .min = 50000,   .max = 200000,  .step = 10000,  .n_bits = 4,
94 };
95
96 static const struct voltage_map_desc *reg_voltage_map[] = {
97         [MAX8997_LDO1] = &ldo_voltage_map_desc,
98         [MAX8997_LDO2] = &ldo_voltage_map_desc,
99         [MAX8997_LDO3] = &ldo_voltage_map_desc,
100         [MAX8997_LDO4] = &ldo_voltage_map_desc,
101         [MAX8997_LDO5] = &ldo_voltage_map_desc,
102         [MAX8997_LDO6] = &ldo_voltage_map_desc,
103         [MAX8997_LDO7] = &ldo_voltage_map_desc,
104         [MAX8997_LDO8] = &ldo_voltage_map_desc,
105         [MAX8997_LDO9] = &ldo_voltage_map_desc,
106         [MAX8997_LDO10] = &ldo_voltage_map_desc,
107         [MAX8997_LDO11] = &ldo_voltage_map_desc,
108         [MAX8997_LDO12] = &ldo_voltage_map_desc,
109         [MAX8997_LDO13] = &ldo_voltage_map_desc,
110         [MAX8997_LDO14] = &ldo_voltage_map_desc,
111         [MAX8997_LDO15] = &ldo_voltage_map_desc,
112         [MAX8997_LDO16] = &ldo_voltage_map_desc,
113         [MAX8997_LDO17] = &ldo_voltage_map_desc,
114         [MAX8997_LDO18] = &ldo_voltage_map_desc,
115         [MAX8997_LDO21] = &ldo_voltage_map_desc,
116         [MAX8997_BUCK1] = &buck1245_voltage_map_desc,
117         [MAX8997_BUCK2] = &buck1245_voltage_map_desc,
118         [MAX8997_BUCK3] = &buck37_voltage_map_desc,
119         [MAX8997_BUCK4] = &buck1245_voltage_map_desc,
120         [MAX8997_BUCK5] = &buck1245_voltage_map_desc,
121         [MAX8997_BUCK6] = NULL,
122         [MAX8997_BUCK7] = &buck37_voltage_map_desc,
123         [MAX8997_EN32KHZ_AP] = NULL,
124         [MAX8997_EN32KHZ_CP] = NULL,
125         [MAX8997_ENVICHG] = NULL,
126         [MAX8997_ESAFEOUT1] = NULL,
127         [MAX8997_ESAFEOUT2] = NULL,
128         [MAX8997_CHARGER_CV] = NULL,
129         [MAX8997_CHARGER] = &charger_current_map_desc,
130         [MAX8997_CHARGER_TOPOFF] = &topoff_current_map_desc,
131 };
132
133 static inline int max8997_get_rid(struct regulator_dev *rdev)
134 {
135         return rdev_get_id(rdev);
136 }
137
138 static int max8997_list_voltage_safeout(struct regulator_dev *rdev,
139                 unsigned int selector)
140 {
141         int rid = max8997_get_rid(rdev);
142
143         if (rid == MAX8997_ESAFEOUT1 || rid == MAX8997_ESAFEOUT2) {
144                 switch (selector) {
145                 case 0:
146                         return 4850000;
147                 case 1:
148                         return 4900000;
149                 case 2:
150                         return 4950000;
151                 case 3:
152                         return 3300000;
153                 default:
154                         return -EINVAL;
155                 }
156         }
157
158         return -EINVAL;
159 }
160
161 static int max8997_list_voltage_charger_cv(struct regulator_dev *rdev,
162                 unsigned int selector)
163 {
164         int rid = max8997_get_rid(rdev);
165
166         if (rid != MAX8997_CHARGER_CV)
167                 goto err;
168
169         switch (selector) {
170         case 0x00:
171                 return 4200000;
172         case 0x01 ... 0x0E:
173                 return 4000000 + 20000 * (selector - 0x01);
174         case 0x0F:
175                 return 4350000;
176         default:
177                 return -EINVAL;
178         }
179 err:
180         return -EINVAL;
181 }
182
183 static int max8997_list_voltage(struct regulator_dev *rdev,
184                 unsigned int selector)
185 {
186         const struct voltage_map_desc *desc;
187         int rid = max8997_get_rid(rdev);
188         int val;
189
190         if (rid >= ARRAY_SIZE(reg_voltage_map) ||
191                         rid < 0)
192                 return -EINVAL;
193
194         desc = reg_voltage_map[rid];
195         if (desc == NULL)
196                 return -EINVAL;
197
198         val = desc->min + desc->step * selector;
199         if (val > desc->max)
200                 return -EINVAL;
201
202         return val;
203 }
204
205 static int max8997_get_enable_register(struct regulator_dev *rdev,
206                 int *reg, int *mask, int *pattern)
207 {
208         int rid = max8997_get_rid(rdev);
209
210         switch (rid) {
211         case MAX8997_LDO1 ... MAX8997_LDO21:
212                 *reg = MAX8997_REG_LDO1CTRL + (rid - MAX8997_LDO1);
213                 *mask = 0xC0;
214                 *pattern = 0xC0;
215                 break;
216         case MAX8997_BUCK1:
217                 *reg = MAX8997_REG_BUCK1CTRL;
218                 *mask = 0x01;
219                 *pattern = 0x01;
220                 break;
221         case MAX8997_BUCK2:
222                 *reg = MAX8997_REG_BUCK2CTRL;
223                 *mask = 0x01;
224                 *pattern = 0x01;
225                 break;
226         case MAX8997_BUCK3:
227                 *reg = MAX8997_REG_BUCK3CTRL;
228                 *mask = 0x01;
229                 *pattern = 0x01;
230                 break;
231         case MAX8997_BUCK4:
232                 *reg = MAX8997_REG_BUCK4CTRL;
233                 *mask = 0x01;
234                 *pattern = 0x01;
235                 break;
236         case MAX8997_BUCK5:
237                 *reg = MAX8997_REG_BUCK5CTRL;
238                 *mask = 0x01;
239                 *pattern = 0x01;
240                 break;
241         case MAX8997_BUCK6:
242                 *reg = MAX8997_REG_BUCK6CTRL;
243                 *mask = 0x01;
244                 *pattern = 0x01;
245                 break;
246         case MAX8997_BUCK7:
247                 *reg = MAX8997_REG_BUCK7CTRL;
248                 *mask = 0x01;
249                 *pattern = 0x01;
250                 break;
251         case MAX8997_EN32KHZ_AP ... MAX8997_EN32KHZ_CP:
252                 *reg = MAX8997_REG_MAINCON1;
253                 *mask = 0x01 << (rid - MAX8997_EN32KHZ_AP);
254                 *pattern = 0x01 << (rid - MAX8997_EN32KHZ_AP);
255                 break;
256         case MAX8997_ENVICHG:
257                 *reg = MAX8997_REG_MBCCTRL1;
258                 *mask = 0x80;
259                 *pattern = 0x80;
260                 break;
261         case MAX8997_ESAFEOUT1 ... MAX8997_ESAFEOUT2:
262                 *reg = MAX8997_REG_SAFEOUTCTRL;
263                 *mask = 0x40 << (rid - MAX8997_ESAFEOUT1);
264                 *pattern = 0x40 << (rid - MAX8997_ESAFEOUT1);
265                 break;
266         case MAX8997_CHARGER:
267                 *reg = MAX8997_REG_MBCCTRL2;
268                 *mask = 0x40;
269                 *pattern = 0x40;
270                 break;
271         default:
272                 /* Not controllable or not exists */
273                 return -EINVAL;
274         }
275
276         return 0;
277 }
278
279 static int max8997_reg_is_enabled(struct regulator_dev *rdev)
280 {
281         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
282         struct i2c_client *i2c = max8997->iodev->i2c;
283         int ret, reg, mask, pattern;
284         u8 val;
285
286         ret = max8997_get_enable_register(rdev, &reg, &mask, &pattern);
287         if (ret == -EINVAL)
288                 return 1; /* "not controllable" */
289         else if (ret)
290                 return ret;
291
292         ret = max8997_read_reg(i2c, reg, &val);
293         if (ret)
294                 return ret;
295
296         return (val & mask) == pattern;
297 }
298
299 static int max8997_reg_enable(struct regulator_dev *rdev)
300 {
301         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
302         struct i2c_client *i2c = max8997->iodev->i2c;
303         int ret, reg, mask, pattern;
304
305         ret = max8997_get_enable_register(rdev, &reg, &mask, &pattern);
306         if (ret)
307                 return ret;
308
309         return max8997_update_reg(i2c, reg, pattern, mask);
310 }
311
312 static int max8997_reg_disable(struct regulator_dev *rdev)
313 {
314         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
315         struct i2c_client *i2c = max8997->iodev->i2c;
316         int ret, reg, mask, pattern;
317
318         ret = max8997_get_enable_register(rdev, &reg, &mask, &pattern);
319         if (ret)
320                 return ret;
321
322         return max8997_update_reg(i2c, reg, ~pattern, mask);
323 }
324
325 static int max8997_get_voltage_register(struct regulator_dev *rdev,
326                 int *_reg, int *_shift, int *_mask)
327 {
328         int rid = max8997_get_rid(rdev);
329         int reg, shift = 0, mask = 0x3f;
330
331         switch (rid) {
332         case MAX8997_LDO1 ... MAX8997_LDO21:
333                 reg = MAX8997_REG_LDO1CTRL + (rid - MAX8997_LDO1);
334                 break;
335         case MAX8997_BUCK1:
336                 reg = MAX8997_REG_BUCK1DVS1;
337                 break;
338         case MAX8997_BUCK2:
339                 reg = MAX8997_REG_BUCK2DVS1;
340                 break;
341         case MAX8997_BUCK3:
342                 reg = MAX8997_REG_BUCK3DVS;
343                 break;
344         case MAX8997_BUCK4:
345                 reg = MAX8997_REG_BUCK4DVS;
346                 break;
347         case MAX8997_BUCK5:
348                 reg = MAX8997_REG_BUCK5DVS1;
349                 break;
350         case MAX8997_BUCK7:
351                 reg = MAX8997_REG_BUCK7DVS;
352                 break;
353         case MAX8997_ESAFEOUT1 ...  MAX8997_ESAFEOUT2:
354                 reg = MAX8997_REG_SAFEOUTCTRL;
355                 shift = (rid == MAX8997_ESAFEOUT2) ? 2 : 0;
356                 mask = 0x3;
357                 break;
358         case MAX8997_CHARGER_CV:
359                 reg = MAX8997_REG_MBCCTRL3;
360                 shift = 0;
361                 mask = 0xf;
362                 break;
363         case MAX8997_CHARGER:
364                 reg = MAX8997_REG_MBCCTRL4;
365                 shift = 0;
366                 mask = 0xf;
367                 break;
368         case MAX8997_CHARGER_TOPOFF:
369                 reg = MAX8997_REG_MBCCTRL5;
370                 shift = 0;
371                 mask = 0xf;
372                 break;
373         default:
374                 return -EINVAL;
375         }
376
377         *_reg = reg;
378         *_shift = shift;
379         *_mask = mask;
380
381         return 0;
382 }
383
384 static int max8997_get_voltage(struct regulator_dev *rdev)
385 {
386         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
387         struct i2c_client *i2c = max8997->iodev->i2c;
388         int reg, shift, mask, ret;
389         int rid = max8997_get_rid(rdev);
390         u8 val;
391
392         ret = max8997_get_voltage_register(rdev, &reg, &shift, &mask);
393         if (ret)
394                 return ret;
395
396         if ((rid == MAX8997_BUCK1 && max8997->buck1_gpiodvs) ||
397                         (rid == MAX8997_BUCK2 && max8997->buck2_gpiodvs) ||
398                         (rid == MAX8997_BUCK5 && max8997->buck5_gpiodvs))
399                 reg += max8997->buck125_gpioindex;
400
401         ret = max8997_read_reg(i2c, reg, &val);
402         if (ret)
403                 return ret;
404
405         val >>= shift;
406         val &= mask;
407
408         if (rdev->desc && rdev->desc->ops && rdev->desc->ops->list_voltage)
409                 return rdev->desc->ops->list_voltage(rdev, val);
410
411         /*
412          * max8997_list_voltage returns value for any rdev with voltage_map,
413          * which works for "CHARGER" and "CHARGER TOPOFF" that do not have
414          * list_voltage ops (they are current regulators).
415          */
416         return max8997_list_voltage(rdev, val);
417 }
418
419 static inline int max8997_get_voltage_proper_val(
420                 const struct voltage_map_desc *desc,
421                 int min_vol, int max_vol)
422 {
423         int i = 0;
424
425         if (desc == NULL)
426                 return -EINVAL;
427
428         if (max_vol < desc->min || min_vol > desc->max)
429                 return -EINVAL;
430
431         while (desc->min + desc->step * i < min_vol &&
432                         desc->min + desc->step * i < desc->max)
433                 i++;
434
435         if (desc->min + desc->step * i > max_vol)
436                 return -EINVAL;
437
438         if (i >= (1 << desc->n_bits))
439                 return -EINVAL;
440
441         return i;
442 }
443
444 static int max8997_set_voltage_charger_cv(struct regulator_dev *rdev,
445                 int min_uV, int max_uV, unsigned *selector)
446 {
447         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
448         struct i2c_client *i2c = max8997->iodev->i2c;
449         int rid = max8997_get_rid(rdev);
450         int lb, ub;
451         int reg, shift = 0, mask, ret = 0;
452         u8 val = 0x0;
453
454         if (rid != MAX8997_CHARGER_CV)
455                 return -EINVAL;
456
457         ret = max8997_get_voltage_register(rdev, &reg, &shift, &mask);
458         if (ret)
459                 return ret;
460
461         if (max_uV < 4000000 || min_uV > 4350000)
462                 return -EINVAL;
463
464         if (min_uV <= 4000000) {
465                 if (max_uV >= 4000000)
466                         return -EINVAL;
467                 else
468                         val = 0x1;
469         } else if (min_uV <= 4200000 && max_uV >= 4200000)
470                 val = 0x0;
471         else {
472                 lb = (min_uV - 4000001) / 20000 + 2;
473                 ub = (max_uV - 4000000) / 20000 + 1;
474
475                 if (lb > ub)
476                         return -EINVAL;
477
478                 if (lb < 0xf)
479                         val = lb;
480                 else {
481                         if (ub >= 0xf)
482                                 val = 0xf;
483                         else
484                                 return -EINVAL;
485                 }
486         }
487
488         *selector = val;
489
490         ret = max8997_update_reg(i2c, reg, val << shift, mask);
491
492         return ret;
493 }
494
495 /*
496  * For LDO1 ~ LDO21, BUCK1~5, BUCK7, CHARGER, CHARGER_TOPOFF
497  * BUCK1, 2, and 5 are available if they are not controlled by gpio
498  */
499 static int max8997_set_voltage_ldobuck(struct regulator_dev *rdev,
500                 int min_uV, int max_uV, unsigned *selector)
501 {
502         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
503         struct i2c_client *i2c = max8997->iodev->i2c;
504         const struct voltage_map_desc *desc;
505         int rid = max8997_get_rid(rdev);
506         int reg, shift = 0, mask, ret;
507         int i;
508         u8 org;
509
510         switch (rid) {
511         case MAX8997_LDO1 ... MAX8997_LDO21:
512                 break;
513         case MAX8997_BUCK1 ... MAX8997_BUCK5:
514                 break;
515         case MAX8997_BUCK6:
516                 return -EINVAL;
517         case MAX8997_BUCK7:
518                 break;
519         case MAX8997_CHARGER:
520                 break;
521         case MAX8997_CHARGER_TOPOFF:
522                 break;
523         default:
524                 return -EINVAL;
525         }
526
527         desc = reg_voltage_map[rid];
528
529         i = max8997_get_voltage_proper_val(desc, min_uV, max_uV);
530         if (i < 0)
531                 return i;
532
533         ret = max8997_get_voltage_register(rdev, &reg, &shift, &mask);
534         if (ret)
535                 return ret;
536
537         max8997_read_reg(i2c, reg, &org);
538         org = (org & mask) >> shift;
539
540         ret = max8997_update_reg(i2c, reg, i << shift, mask << shift);
541         *selector = i;
542
543         if (rid == MAX8997_BUCK1 || rid == MAX8997_BUCK2 ||
544                         rid == MAX8997_BUCK4 || rid == MAX8997_BUCK5) {
545                 /* If the voltage is increasing */
546                 if (org < i)
547                         udelay(DIV_ROUND_UP(desc->step * (i - org),
548                                                 max8997->ramp_delay * 1000));
549         }
550
551         return ret;
552 }
553
554 /*
555  * Assess the damage on the voltage setting of BUCK1,2,5 by the change.
556  *
557  * When GPIO-DVS mode is used for multiple bucks, changing the voltage value
558  * of one of the bucks may affect that of another buck, which is the side
559  * effect of the change (set_voltage). This function examines the GPIO-DVS
560  * configurations and checks whether such side-effect exists.
561  */
562 static int max8997_assess_side_effect(struct regulator_dev *rdev,
563                 u8 new_val, int *best)
564 {
565         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
566         int rid = max8997_get_rid(rdev);
567         u8 *buckx_val[3];
568         bool buckx_gpiodvs[3];
569         int side_effect[8];
570         int min_side_effect = INT_MAX;
571         int i;
572
573         *best = -1;
574
575         switch (rid) {
576         case MAX8997_BUCK1:
577                 rid = 0;
578                 break;
579         case MAX8997_BUCK2:
580                 rid = 1;
581                 break;
582         case MAX8997_BUCK5:
583                 rid = 2;
584                 break;
585         default:
586                 return -EINVAL;
587         }
588
589         buckx_val[0] = max8997->buck1_vol;
590         buckx_val[1] = max8997->buck2_vol;
591         buckx_val[2] = max8997->buck5_vol;
592         buckx_gpiodvs[0] = max8997->buck1_gpiodvs;
593         buckx_gpiodvs[1] = max8997->buck2_gpiodvs;
594         buckx_gpiodvs[2] = max8997->buck5_gpiodvs;
595
596         for (i = 0; i < 8; i++) {
597                 int others;
598
599                 if (new_val != (buckx_val[rid])[i]) {
600                         side_effect[i] = -1;
601                         continue;
602                 }
603
604                 side_effect[i] = 0;
605                 for (others = 0; others < 3; others++) {
606                         int diff;
607
608                         if (others == rid)
609                                 continue;
610                         if (buckx_gpiodvs[others] == false)
611                                 continue; /* Not affected */
612                         diff = (buckx_val[others])[i] -
613                                 (buckx_val[others])[max8997->buck125_gpioindex];
614                         if (diff > 0)
615                                 side_effect[i] += diff;
616                         else if (diff < 0)
617                                 side_effect[i] -= diff;
618                 }
619                 if (side_effect[i] == 0) {
620                         *best = i;
621                         return 0; /* NO SIDE EFFECT! Use This! */
622                 }
623                 if (side_effect[i] < min_side_effect) {
624                         min_side_effect = side_effect[i];
625                         *best = i;
626                 }
627         }
628
629         if (*best == -1)
630                 return -EINVAL;
631
632         return side_effect[*best];
633 }
634
635 /*
636  * For Buck 1 ~ 5 and 7. If it is not controlled by GPIO, this calls
637  * max8997_set_voltage_ldobuck to do the job.
638  */
639 static int max8997_set_voltage_buck(struct regulator_dev *rdev,
640                 int min_uV, int max_uV, unsigned *selector)
641 {
642         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
643         int rid = max8997_get_rid(rdev);
644         const struct voltage_map_desc *desc;
645         int new_val, new_idx, damage, tmp_val, tmp_idx, tmp_dmg;
646         bool gpio_dvs_mode = false;
647
648         if (rid < MAX8997_BUCK1 || rid > MAX8997_BUCK7)
649                 return -EINVAL;
650
651         switch (rid) {
652         case MAX8997_BUCK1:
653                 if (max8997->buck1_gpiodvs)
654                         gpio_dvs_mode = true;
655                 break;
656         case MAX8997_BUCK2:
657                 if (max8997->buck2_gpiodvs)
658                         gpio_dvs_mode = true;
659                 break;
660         case MAX8997_BUCK5:
661                 if (max8997->buck5_gpiodvs)
662                         gpio_dvs_mode = true;
663                 break;
664         }
665
666         if (!gpio_dvs_mode)
667                 return max8997_set_voltage_ldobuck(rdev, min_uV, max_uV,
668                                                 selector);
669
670         desc = reg_voltage_map[rid];
671         new_val = max8997_get_voltage_proper_val(desc, min_uV, max_uV);
672         if (new_val < 0)
673                 return new_val;
674
675         tmp_dmg = INT_MAX;
676         tmp_idx = -1;
677         tmp_val = -1;
678         do {
679                 damage = max8997_assess_side_effect(rdev, new_val, &new_idx);
680                 if (damage == 0)
681                         goto out;
682
683                 if (tmp_dmg > damage) {
684                         tmp_idx = new_idx;
685                         tmp_val = new_val;
686                         tmp_dmg = damage;
687                 }
688
689                 new_val++;
690         } while (desc->min + desc->step * new_val <= desc->max);
691
692         new_idx = tmp_idx;
693         new_val = tmp_val;
694
695         if (max8997->ignore_gpiodvs_side_effect == false)
696                 return -EINVAL;
697
698         dev_warn(&rdev->dev, "MAX8997 GPIO-DVS Side Effect Warning: GPIO SET:"
699                         " %d -> %d\n", max8997->buck125_gpioindex, tmp_idx);
700
701 out:
702         if (new_idx < 0 || new_val < 0)
703                 return -EINVAL;
704
705         max8997->buck125_gpioindex = new_idx;
706         max8997_set_gpio(max8997);
707         *selector = new_val;
708
709         return 0;
710 }
711
712 static const int safeoutvolt[] = {
713         3300000,
714         4850000,
715         4900000,
716         4950000,
717 };
718
719 /* For SAFEOUT1 and SAFEOUT2 */
720 static int max8997_set_voltage_safeout(struct regulator_dev *rdev,
721                 int min_uV, int max_uV, unsigned *selector)
722 {
723         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
724         struct i2c_client *i2c = max8997->iodev->i2c;
725         int rid = max8997_get_rid(rdev);
726         int reg, shift = 0, mask, ret;
727         int i = 0;
728         u8 val;
729
730         if (rid != MAX8997_ESAFEOUT1 && rid != MAX8997_ESAFEOUT2)
731                 return -EINVAL;
732
733         for (i = 0; i < ARRAY_SIZE(safeoutvolt); i++) {
734                 if (min_uV <= safeoutvolt[i] &&
735                                 max_uV >= safeoutvolt[i])
736                         break;
737         }
738
739         if (i >= ARRAY_SIZE(safeoutvolt))
740                 return -EINVAL;
741
742         if (i == 0)
743                 val = 0x3;
744         else
745                 val = i - 1;
746
747         ret = max8997_get_voltage_register(rdev, &reg, &shift, &mask);
748         if (ret)
749                 return ret;
750
751         ret = max8997_update_reg(i2c, reg, val << shift, mask << shift);
752         *selector = val;
753
754         return ret;
755 }
756
757 static int max8997_reg_enable_suspend(struct regulator_dev *rdev)
758 {
759         return 0;
760 }
761
762 static int max8997_reg_disable_suspend(struct regulator_dev *rdev)
763 {
764         struct max8997_data *max8997 = rdev_get_drvdata(rdev);
765         struct i2c_client *i2c = max8997->iodev->i2c;
766         int ret, reg, mask, pattern;
767         int rid = max8997_get_rid(rdev);
768
769         ret = max8997_get_enable_register(rdev, &reg, &mask, &pattern);
770         if (ret)
771                 return ret;
772
773         max8997_read_reg(i2c, reg, &max8997->saved_states[rid]);
774
775         if (rid == MAX8997_LDO1 ||
776                         rid == MAX8997_LDO10 ||
777                         rid == MAX8997_LDO21) {
778                 dev_dbg(&rdev->dev, "Conditional Power-Off for %s\n",
779                                 rdev->desc->name);
780                 return max8997_update_reg(i2c, reg, 0x40, mask);
781         }
782
783         dev_dbg(&rdev->dev, "Full Power-Off for %s (%xh -> %xh)\n",
784                         rdev->desc->name, max8997->saved_states[rid] & mask,
785                         (~pattern) & mask);
786         return max8997_update_reg(i2c, reg, ~pattern, mask);
787 }
788
789 static struct regulator_ops max8997_ldo_ops = {
790         .list_voltage           = max8997_list_voltage,
791         .is_enabled             = max8997_reg_is_enabled,
792         .enable                 = max8997_reg_enable,
793         .disable                = max8997_reg_disable,
794         .get_voltage            = max8997_get_voltage,
795         .set_voltage            = max8997_set_voltage_ldobuck,
796         .set_suspend_enable     = max8997_reg_enable_suspend,
797         .set_suspend_disable    = max8997_reg_disable_suspend,
798 };
799
800 static struct regulator_ops max8997_buck_ops = {
801         .list_voltage           = max8997_list_voltage,
802         .is_enabled             = max8997_reg_is_enabled,
803         .enable                 = max8997_reg_enable,
804         .disable                = max8997_reg_disable,
805         .get_voltage            = max8997_get_voltage,
806         .set_voltage            = max8997_set_voltage_buck,
807         .set_suspend_enable     = max8997_reg_enable_suspend,
808         .set_suspend_disable    = max8997_reg_disable_suspend,
809 };
810
811 static struct regulator_ops max8997_fixedvolt_ops = {
812         .list_voltage           = max8997_list_voltage,
813         .is_enabled             = max8997_reg_is_enabled,
814         .enable                 = max8997_reg_enable,
815         .disable                = max8997_reg_disable,
816         .set_suspend_enable     = max8997_reg_enable_suspend,
817         .set_suspend_disable    = max8997_reg_disable_suspend,
818 };
819
820 static struct regulator_ops max8997_safeout_ops = {
821         .list_voltage           = max8997_list_voltage_safeout,
822         .is_enabled             = max8997_reg_is_enabled,
823         .enable                 = max8997_reg_enable,
824         .disable                = max8997_reg_disable,
825         .get_voltage            = max8997_get_voltage,
826         .set_voltage            = max8997_set_voltage_safeout,
827         .set_suspend_enable     = max8997_reg_enable_suspend,
828         .set_suspend_disable    = max8997_reg_disable_suspend,
829 };
830
831 static struct regulator_ops max8997_fixedstate_ops = {
832         .list_voltage           = max8997_list_voltage_charger_cv,
833         .get_voltage            = max8997_get_voltage,
834         .set_voltage            = max8997_set_voltage_charger_cv,
835 };
836
837 static int max8997_set_voltage_ldobuck_wrap(struct regulator_dev *rdev,
838                 int min_uV, int max_uV)
839 {
840         unsigned dummy;
841
842         return max8997_set_voltage_ldobuck(rdev, min_uV, max_uV, &dummy);
843 }
844
845
846 static struct regulator_ops max8997_charger_ops = {
847         .is_enabled             = max8997_reg_is_enabled,
848         .enable                 = max8997_reg_enable,
849         .disable                = max8997_reg_disable,
850         .get_current_limit      = max8997_get_voltage,
851         .set_current_limit      = max8997_set_voltage_ldobuck_wrap,
852 };
853
854 static struct regulator_ops max8997_charger_fixedstate_ops = {
855         .is_enabled             = max8997_reg_is_enabled,
856         .get_current_limit      = max8997_get_voltage,
857         .set_current_limit      = max8997_set_voltage_ldobuck_wrap,
858 };
859
860 #define regulator_desc_ldo(num)         {       \
861         .name           = "LDO"#num,            \
862         .id             = MAX8997_LDO##num,     \
863         .ops            = &max8997_ldo_ops,     \
864         .type           = REGULATOR_VOLTAGE,    \
865         .owner          = THIS_MODULE,          \
866 }
867 #define regulator_desc_buck(num)                {       \
868         .name           = "BUCK"#num,           \
869         .id             = MAX8997_BUCK##num,    \
870         .ops            = &max8997_buck_ops,    \
871         .type           = REGULATOR_VOLTAGE,    \
872         .owner          = THIS_MODULE,          \
873 }
874
875 static struct regulator_desc regulators[] = {
876         regulator_desc_ldo(1),
877         regulator_desc_ldo(2),
878         regulator_desc_ldo(3),
879         regulator_desc_ldo(4),
880         regulator_desc_ldo(5),
881         regulator_desc_ldo(6),
882         regulator_desc_ldo(7),
883         regulator_desc_ldo(8),
884         regulator_desc_ldo(9),
885         regulator_desc_ldo(10),
886         regulator_desc_ldo(11),
887         regulator_desc_ldo(12),
888         regulator_desc_ldo(13),
889         regulator_desc_ldo(14),
890         regulator_desc_ldo(15),
891         regulator_desc_ldo(16),
892         regulator_desc_ldo(17),
893         regulator_desc_ldo(18),
894         regulator_desc_ldo(21),
895         regulator_desc_buck(1),
896         regulator_desc_buck(2),
897         regulator_desc_buck(3),
898         regulator_desc_buck(4),
899         regulator_desc_buck(5),
900         {
901                 .name   = "BUCK6",
902                 .id     = MAX8997_BUCK6,
903                 .ops    = &max8997_fixedvolt_ops,
904                 .type   = REGULATOR_VOLTAGE,
905                 .owner  = THIS_MODULE,
906         },
907         regulator_desc_buck(7),
908         {
909                 .name   = "EN32KHz AP",
910                 .id     = MAX8997_EN32KHZ_AP,
911                 .ops    = &max8997_fixedvolt_ops,
912                 .type   = REGULATOR_VOLTAGE,
913                 .owner  = THIS_MODULE,
914         }, {
915                 .name   = "EN32KHz CP",
916                 .id     = MAX8997_EN32KHZ_CP,
917                 .ops    = &max8997_fixedvolt_ops,
918                 .type   = REGULATOR_VOLTAGE,
919                 .owner  = THIS_MODULE,
920         }, {
921                 .name   = "ENVICHG",
922                 .id     = MAX8997_ENVICHG,
923                 .ops    = &max8997_fixedvolt_ops,
924                 .type   = REGULATOR_VOLTAGE,
925                 .owner  = THIS_MODULE,
926         }, {
927                 .name   = "ESAFEOUT1",
928                 .id     = MAX8997_ESAFEOUT1,
929                 .ops    = &max8997_safeout_ops,
930                 .type   = REGULATOR_VOLTAGE,
931                 .owner   = THIS_MODULE,
932         }, {
933                 .name   = "ESAFEOUT2",
934                 .id     = MAX8997_ESAFEOUT2,
935                 .ops    = &max8997_safeout_ops,
936                 .type   = REGULATOR_VOLTAGE,
937                 .owner   = THIS_MODULE,
938         }, {
939                 .name   = "CHARGER CV",
940                 .id     = MAX8997_CHARGER_CV,
941                 .ops    = &max8997_fixedstate_ops,
942                 .type   = REGULATOR_VOLTAGE,
943                 .owner   = THIS_MODULE,
944         }, {
945                 .name   = "CHARGER",
946                 .id     = MAX8997_CHARGER,
947                 .ops    = &max8997_charger_ops,
948                 .type   = REGULATOR_CURRENT,
949                 .owner   = THIS_MODULE,
950         }, {
951                 .name   = "CHARGER TOPOFF",
952                 .id     = MAX8997_CHARGER_TOPOFF,
953                 .ops    = &max8997_charger_fixedstate_ops,
954                 .type   = REGULATOR_CURRENT,
955                 .owner   = THIS_MODULE,
956         },
957 };
958
959 static __devinit int max8997_pmic_probe(struct platform_device *pdev)
960 {
961         struct max8997_dev *iodev = dev_get_drvdata(pdev->dev.parent);
962         struct max8997_platform_data *pdata = dev_get_platdata(iodev->dev);
963         struct regulator_dev **rdev;
964         struct max8997_data *max8997;
965         struct i2c_client *i2c;
966         int i, ret, size;
967         u8 max_buck1 = 0, max_buck2 = 0, max_buck5 = 0;
968
969         if (!pdata) {
970                 dev_err(pdev->dev.parent, "No platform init data supplied.\n");
971                 return -ENODEV;
972         }
973
974         max8997 = kzalloc(sizeof(struct max8997_data), GFP_KERNEL);
975         if (!max8997)
976                 return -ENOMEM;
977
978         size = sizeof(struct regulator_dev *) * pdata->num_regulators;
979         max8997->rdev = kzalloc(size, GFP_KERNEL);
980         if (!max8997->rdev) {
981                 kfree(max8997);
982                 return -ENOMEM;
983         }
984
985         rdev = max8997->rdev;
986         max8997->dev = &pdev->dev;
987         max8997->iodev = iodev;
988         max8997->num_regulators = pdata->num_regulators;
989         platform_set_drvdata(pdev, max8997);
990         i2c = max8997->iodev->i2c;
991
992         max8997->buck125_gpioindex = pdata->buck125_default_idx;
993         max8997->buck1_gpiodvs = pdata->buck1_gpiodvs;
994         max8997->buck2_gpiodvs = pdata->buck2_gpiodvs;
995         max8997->buck5_gpiodvs = pdata->buck5_gpiodvs;
996         memcpy(max8997->buck125_gpios, pdata->buck125_gpios, sizeof(int) * 3);
997         max8997->ignore_gpiodvs_side_effect = pdata->ignore_gpiodvs_side_effect;
998
999         for (i = 0; i < 8; i++) {
1000                 max8997->buck1_vol[i] = ret =
1001                         max8997_get_voltage_proper_val(
1002                                         &buck1245_voltage_map_desc,
1003                                         pdata->buck1_voltage[i],
1004                                         pdata->buck1_voltage[i] +
1005                                         buck1245_voltage_map_desc.step);
1006                 if (ret < 0)
1007                         goto err_alloc;
1008
1009                 max8997->buck2_vol[i] = ret =
1010                         max8997_get_voltage_proper_val(
1011                                         &buck1245_voltage_map_desc,
1012                                         pdata->buck2_voltage[i],
1013                                         pdata->buck2_voltage[i] +
1014                                         buck1245_voltage_map_desc.step);
1015                 if (ret < 0)
1016                         goto err_alloc;
1017
1018                 max8997->buck5_vol[i] = ret =
1019                         max8997_get_voltage_proper_val(
1020                                         &buck1245_voltage_map_desc,
1021                                         pdata->buck5_voltage[i],
1022                                         pdata->buck5_voltage[i] +
1023                                         buck1245_voltage_map_desc.step);
1024                 if (ret < 0)
1025                         goto err_alloc;
1026
1027                 if (max_buck1 < max8997->buck1_vol[i])
1028                         max_buck1 = max8997->buck1_vol[i];
1029                 if (max_buck2 < max8997->buck2_vol[i])
1030                         max_buck2 = max8997->buck2_vol[i];
1031                 if (max_buck5 < max8997->buck5_vol[i])
1032                         max_buck5 = max8997->buck5_vol[i];
1033         }
1034
1035         /* For the safety, set max voltage before setting up */
1036         for (i = 0; i < 8; i++) {
1037                 max8997_update_reg(i2c, MAX8997_REG_BUCK1DVS1 + i,
1038                                 max_buck1, 0x3f);
1039                 max8997_update_reg(i2c, MAX8997_REG_BUCK2DVS1 + i,
1040                                 max_buck2, 0x3f);
1041                 max8997_update_reg(i2c, MAX8997_REG_BUCK5DVS1 + i,
1042                                 max_buck5, 0x3f);
1043         }
1044
1045         /*
1046          * If buck 1, 2, and 5 do not care DVS GPIO settings, ignore them.
1047          * If at least one of them cares, set gpios.
1048          */
1049         if (pdata->buck1_gpiodvs || pdata->buck2_gpiodvs ||
1050                         pdata->buck5_gpiodvs) {
1051                 bool gpio1set = false, gpio2set = false;
1052
1053                 if (!gpio_is_valid(pdata->buck125_gpios[0]) ||
1054                                 !gpio_is_valid(pdata->buck125_gpios[1]) ||
1055                                 !gpio_is_valid(pdata->buck125_gpios[2])) {
1056                         dev_err(&pdev->dev, "GPIO NOT VALID\n");
1057                         ret = -EINVAL;
1058                         goto err_alloc;
1059                 }
1060
1061                 ret = gpio_request(pdata->buck125_gpios[0],
1062                                 "MAX8997 SET1");
1063                 if (ret == -EBUSY)
1064                         dev_warn(&pdev->dev, "Duplicated gpio request"
1065                                         " on SET1\n");
1066                 else if (ret)
1067                         goto err_alloc;
1068                 else
1069                         gpio1set = true;
1070
1071                 ret = gpio_request(pdata->buck125_gpios[1],
1072                                 "MAX8997 SET2");
1073                 if (ret == -EBUSY)
1074                         dev_warn(&pdev->dev, "Duplicated gpio request"
1075                                         " on SET2\n");
1076                 else if (ret) {
1077                         if (gpio1set)
1078                                 gpio_free(pdata->buck125_gpios[0]);
1079                         goto err_alloc;
1080                 } else
1081                         gpio2set = true;
1082
1083                 ret = gpio_request(pdata->buck125_gpios[2],
1084                                 "MAX8997 SET3");
1085                 if (ret == -EBUSY)
1086                         dev_warn(&pdev->dev, "Duplicated gpio request"
1087                                         " on SET3\n");
1088                 else if (ret) {
1089                         if (gpio1set)
1090                                 gpio_free(pdata->buck125_gpios[0]);
1091                         if (gpio2set)
1092                                 gpio_free(pdata->buck125_gpios[1]);
1093                         goto err_alloc;
1094                 }
1095
1096                 gpio_direction_output(pdata->buck125_gpios[0],
1097                                 (max8997->buck125_gpioindex >> 2)
1098                                 & 0x1); /* SET1 */
1099                 gpio_direction_output(pdata->buck125_gpios[1],
1100                                 (max8997->buck125_gpioindex >> 1)
1101                                 & 0x1); /* SET2 */
1102                 gpio_direction_output(pdata->buck125_gpios[2],
1103                                 (max8997->buck125_gpioindex >> 0)
1104                                 & 0x1); /* SET3 */
1105                 ret = 0;
1106         }
1107
1108         /* DVS-GPIO disabled */
1109         max8997_update_reg(i2c, MAX8997_REG_BUCK1CTRL, (pdata->buck1_gpiodvs) ?
1110                         (1 << 1) : (0 << 1), 1 << 1);
1111         max8997_update_reg(i2c, MAX8997_REG_BUCK2CTRL, (pdata->buck2_gpiodvs) ?
1112                         (1 << 1) : (0 << 1), 1 << 1);
1113         max8997_update_reg(i2c, MAX8997_REG_BUCK5CTRL, (pdata->buck5_gpiodvs) ?
1114                         (1 << 1) : (0 << 1), 1 << 1);
1115
1116         /* Initialize all the DVS related BUCK registers */
1117         for (i = 0; i < 8; i++) {
1118                 max8997_update_reg(i2c, MAX8997_REG_BUCK1DVS1 + i,
1119                                 max8997->buck1_vol[i],
1120                                 0x3f);
1121                 max8997_update_reg(i2c, MAX8997_REG_BUCK2DVS1 + i,
1122                                 max8997->buck2_vol[i],
1123                                 0x3f);
1124                 max8997_update_reg(i2c, MAX8997_REG_BUCK5DVS1 + i,
1125                                 max8997->buck5_vol[i],
1126                                 0x3f);
1127         }
1128
1129         /* Misc Settings */
1130         max8997->ramp_delay = 10; /* set 10mV/us, which is the default */
1131         max8997_write_reg(i2c, MAX8997_REG_BUCKRAMP, (0xf << 4) | 0x9);
1132
1133         for (i = 0; i < pdata->num_regulators; i++) {
1134                 const struct voltage_map_desc *desc;
1135                 int id = pdata->regulators[i].id;
1136
1137                 desc = reg_voltage_map[id];
1138                 if (desc)
1139                         regulators[id].n_voltages =
1140                                 (desc->max - desc->min) / desc->step + 1;
1141                 else if (id == MAX8997_ESAFEOUT1 || id == MAX8997_ESAFEOUT2)
1142                         regulators[id].n_voltages = 4;
1143                 else if (id == MAX8997_CHARGER_CV)
1144                         regulators[id].n_voltages = 16;
1145
1146                 rdev[i] = regulator_register(&regulators[id], max8997->dev,
1147                                 pdata->regulators[i].initdata, max8997);
1148                 if (IS_ERR(rdev[i])) {
1149                         ret = PTR_ERR(rdev[i]);
1150                         dev_err(max8997->dev, "regulator init failed for %d\n",
1151                                         id);
1152                         rdev[i] = NULL;
1153                         goto err;
1154                 }
1155         }
1156
1157         return 0;
1158 err:
1159         for (i = 0; i < max8997->num_regulators; i++)
1160                 if (rdev[i])
1161                         regulator_unregister(rdev[i]);
1162 err_alloc:
1163         kfree(max8997->rdev);
1164         kfree(max8997);
1165
1166         return ret;
1167 }
1168
1169 static int __devexit max8997_pmic_remove(struct platform_device *pdev)
1170 {
1171         struct max8997_data *max8997 = platform_get_drvdata(pdev);
1172         struct regulator_dev **rdev = max8997->rdev;
1173         int i;
1174
1175         for (i = 0; i < max8997->num_regulators; i++)
1176                 if (rdev[i])
1177                         regulator_unregister(rdev[i]);
1178
1179         kfree(max8997->rdev);
1180         kfree(max8997);
1181
1182         return 0;
1183 }
1184
1185 static const struct platform_device_id max8997_pmic_id[] = {
1186         { "max8997-pmic", 0},
1187         { },
1188 };
1189 MODULE_DEVICE_TABLE(platform, max8997_pmic_id);
1190
1191 static struct platform_driver max8997_pmic_driver = {
1192         .driver = {
1193                 .name = "max8997-pmic",
1194                 .owner = THIS_MODULE,
1195         },
1196         .probe = max8997_pmic_probe,
1197         .remove = __devexit_p(max8997_pmic_remove),
1198         .id_table = max8997_pmic_id,
1199 };
1200
1201 static int __init max8997_pmic_init(void)
1202 {
1203         return platform_driver_register(&max8997_pmic_driver);
1204 }
1205 subsys_initcall(max8997_pmic_init);
1206
1207 static void __exit max8997_pmic_cleanup(void)
1208 {
1209         platform_driver_unregister(&max8997_pmic_driver);
1210 }
1211 module_exit(max8997_pmic_cleanup);
1212
1213 MODULE_DESCRIPTION("MAXIM 8997/8966 Regulator Driver");
1214 MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
1215 MODULE_LICENSE("GPL");