parport_pc: show the detection of a 2 serial port ITE8874 chip
[linux-2.6.git] / drivers / regulator / mc13783-regulator.c
1 /*
2  * Regulator Driver for Freescale MC13783 PMIC
3  *
4  * Copyright (C) 2008 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de>
5  * Copyright 2009 Alberto Panizzo <maramaopercheseimorto@gmail.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 version 2 as
9  * published by the Free Software Foundation.
10  */
11
12 #include <linux/mfd/mc13783.h>
13 #include <linux/regulator/machine.h>
14 #include <linux/regulator/driver.h>
15 #include <linux/platform_device.h>
16 #include <linux/kernel.h>
17 #include <linux/slab.h>
18 #include <linux/init.h>
19 #include <linux/err.h>
20
21 #define MC13783_REG_SWITCHERS5                  29
22 #define MC13783_REG_SWITCHERS5_SW3EN                    (1 << 20)
23 #define MC13783_REG_SWITCHERS5_SW3VSEL                  18
24 #define MC13783_REG_SWITCHERS5_SW3VSEL_M                (3 << 18)
25
26 #define MC13783_REG_REGULATORSETTING0           30
27 #define MC13783_REG_REGULATORSETTING0_VIOLOVSEL         2
28 #define MC13783_REG_REGULATORSETTING0_VDIGVSEL          4
29 #define MC13783_REG_REGULATORSETTING0_VGENVSEL          6
30 #define MC13783_REG_REGULATORSETTING0_VRFDIGVSEL        9
31 #define MC13783_REG_REGULATORSETTING0_VRFREFVSEL        11
32 #define MC13783_REG_REGULATORSETTING0_VRFCPVSEL         13
33 #define MC13783_REG_REGULATORSETTING0_VSIMVSEL          14
34 #define MC13783_REG_REGULATORSETTING0_VESIMVSEL         15
35 #define MC13783_REG_REGULATORSETTING0_VCAMVSEL          16
36
37 #define MC13783_REG_REGULATORSETTING0_VIOLOVSEL_M       (3 << 2)
38 #define MC13783_REG_REGULATORSETTING0_VDIGVSEL_M        (3 << 4)
39 #define MC13783_REG_REGULATORSETTING0_VGENVSEL_M        (7 << 6)
40 #define MC13783_REG_REGULATORSETTING0_VRFDIGVSEL_M      (3 << 9)
41 #define MC13783_REG_REGULATORSETTING0_VRFREFVSEL_M      (3 << 11)
42 #define MC13783_REG_REGULATORSETTING0_VRFCPVSEL_M       (1 << 13)
43 #define MC13783_REG_REGULATORSETTING0_VSIMVSEL_M        (1 << 14)
44 #define MC13783_REG_REGULATORSETTING0_VESIMVSEL_M       (1 << 15)
45 #define MC13783_REG_REGULATORSETTING0_VCAMVSEL_M        (7 << 16)
46
47 #define MC13783_REG_REGULATORSETTING1           31
48 #define MC13783_REG_REGULATORSETTING1_VVIBVSEL          0
49 #define MC13783_REG_REGULATORSETTING1_VRF1VSEL          2
50 #define MC13783_REG_REGULATORSETTING1_VRF2VSEL          4
51 #define MC13783_REG_REGULATORSETTING1_VMMC1VSEL         6
52 #define MC13783_REG_REGULATORSETTING1_VMMC2VSEL         9
53
54 #define MC13783_REG_REGULATORSETTING1_VVIBVSEL_M        (3 << 0)
55 #define MC13783_REG_REGULATORSETTING1_VRF1VSEL_M        (3 << 2)
56 #define MC13783_REG_REGULATORSETTING1_VRF2VSEL_M        (3 << 4)
57 #define MC13783_REG_REGULATORSETTING1_VMMC1VSEL_M       (7 << 6)
58 #define MC13783_REG_REGULATORSETTING1_VMMC2VSEL_M       (7 << 9)
59
60 #define MC13783_REG_REGULATORMODE0              32
61 #define MC13783_REG_REGULATORMODE0_VAUDIOEN             (1 << 0)
62 #define MC13783_REG_REGULATORMODE0_VIOHIEN              (1 << 3)
63 #define MC13783_REG_REGULATORMODE0_VIOLOEN              (1 << 6)
64 #define MC13783_REG_REGULATORMODE0_VDIGEN               (1 << 9)
65 #define MC13783_REG_REGULATORMODE0_VGENEN               (1 << 12)
66 #define MC13783_REG_REGULATORMODE0_VRFDIGEN             (1 << 15)
67 #define MC13783_REG_REGULATORMODE0_VRFREFEN             (1 << 18)
68 #define MC13783_REG_REGULATORMODE0_VRFCPEN              (1 << 21)
69
70 #define MC13783_REG_REGULATORMODE1              33
71 #define MC13783_REG_REGULATORMODE1_VSIMEN               (1 << 0)
72 #define MC13783_REG_REGULATORMODE1_VESIMEN              (1 << 3)
73 #define MC13783_REG_REGULATORMODE1_VCAMEN               (1 << 6)
74 #define MC13783_REG_REGULATORMODE1_VRFBGEN              (1 << 9)
75 #define MC13783_REG_REGULATORMODE1_VVIBEN               (1 << 11)
76 #define MC13783_REG_REGULATORMODE1_VRF1EN               (1 << 12)
77 #define MC13783_REG_REGULATORMODE1_VRF2EN               (1 << 15)
78 #define MC13783_REG_REGULATORMODE1_VMMC1EN              (1 << 18)
79 #define MC13783_REG_REGULATORMODE1_VMMC2EN              (1 << 21)
80
81 #define MC13783_REG_POWERMISC                   34
82 #define MC13783_REG_POWERMISC_GPO1EN                    (1 << 6)
83 #define MC13783_REG_POWERMISC_GPO2EN                    (1 << 8)
84 #define MC13783_REG_POWERMISC_GPO3EN                    (1 << 10)
85 #define MC13783_REG_POWERMISC_GPO4EN                    (1 << 12)
86 #define MC13783_REG_POWERMISC_PWGT1SPIEN                (1 << 15)
87 #define MC13783_REG_POWERMISC_PWGT2SPIEN                (1 << 16)
88
89 #define MC13783_REG_POWERMISC_PWGTSPI_M                 (3 << 15)
90
91
92 struct mc13783_regulator {
93         struct regulator_desc desc;
94         int reg;
95         int enable_bit;
96         int vsel_reg;
97         int vsel_shift;
98         int vsel_mask;
99         int const *voltages;
100 };
101
102 /* Voltage Values */
103 static const int const mc13783_sw3_val[] = {
104         5000000, 5000000, 5000000, 5500000,
105 };
106
107 static const int const mc13783_vaudio_val[] = {
108         2775000,
109 };
110
111 static const int const mc13783_viohi_val[] = {
112         2775000,
113 };
114
115 static const int const mc13783_violo_val[] = {
116         1200000, 1300000, 1500000, 1800000,
117 };
118
119 static const int const mc13783_vdig_val[] = {
120         1200000, 1300000, 1500000, 1800000,
121 };
122
123 static const int const mc13783_vgen_val[] = {
124         1200000, 1300000, 1500000, 1800000,
125         1100000, 2000000, 2775000, 2400000,
126 };
127
128 static const int const mc13783_vrfdig_val[] = {
129         1200000, 1500000, 1800000, 1875000,
130 };
131
132 static const int const mc13783_vrfref_val[] = {
133         2475000, 2600000, 2700000, 2775000,
134 };
135
136 static const int const mc13783_vrfcp_val[] = {
137         2700000, 2775000,
138 };
139
140 static const int const mc13783_vsim_val[] = {
141         1800000, 2900000, 3000000,
142 };
143
144 static const int const mc13783_vesim_val[] = {
145         1800000, 2900000,
146 };
147
148 static const int const mc13783_vcam_val[] = {
149         1500000, 1800000, 2500000, 2550000,
150         2600000, 2750000, 2800000, 3000000,
151 };
152
153 static const int const mc13783_vrfbg_val[] = {
154         1250000,
155 };
156
157 static const int const mc13783_vvib_val[] = {
158         1300000, 1800000, 2000000, 3000000,
159 };
160
161 static const int const mc13783_vmmc_val[] = {
162         1600000, 1800000, 2000000, 2600000,
163         2700000, 2800000, 2900000, 3000000,
164 };
165
166 static const int const mc13783_vrf_val[] = {
167         1500000, 1875000, 2700000, 2775000,
168 };
169
170 static const int const mc13783_gpo_val[] = {
171         3100000,
172 };
173
174 static const int const mc13783_pwgtdrv_val[] = {
175         5500000,
176 };
177
178 static struct regulator_ops mc13783_regulator_ops;
179 static struct regulator_ops mc13783_fixed_regulator_ops;
180 static struct regulator_ops mc13783_gpo_regulator_ops;
181
182 #define MC13783_DEFINE(prefix, _name, _reg, _vsel_reg, _voltages)       \
183         [MC13783_ ## prefix ## _ ## _name] = {                          \
184                 .desc = {                                               \
185                         .name = #prefix "_" #_name,                     \
186                         .n_voltages = ARRAY_SIZE(_voltages),            \
187                         .ops = &mc13783_regulator_ops,                  \
188                         .type = REGULATOR_VOLTAGE,                      \
189                         .id = MC13783_ ## prefix ## _ ## _name,         \
190                         .owner = THIS_MODULE,                           \
191                 },                                                      \
192                 .reg = MC13783_REG_ ## _reg,                            \
193                 .enable_bit = MC13783_REG_ ## _reg ## _ ## _name ## EN, \
194                 .vsel_reg = MC13783_REG_ ## _vsel_reg,                  \
195                 .vsel_shift = MC13783_REG_ ## _vsel_reg ## _ ## _name ## VSEL,\
196                 .vsel_mask = MC13783_REG_ ## _vsel_reg ## _ ## _name ## VSEL_M,\
197                 .voltages =  _voltages,                                 \
198         }
199
200 #define MC13783_FIXED_DEFINE(prefix, _name, _reg, _voltages)            \
201         [MC13783_ ## prefix ## _ ## _name] = {                          \
202                 .desc = {                                               \
203                         .name = #prefix "_" #_name,                     \
204                         .n_voltages = ARRAY_SIZE(_voltages),            \
205                         .ops = &mc13783_fixed_regulator_ops,            \
206                         .type = REGULATOR_VOLTAGE,                      \
207                         .id = MC13783_ ## prefix ## _ ## _name,         \
208                         .owner = THIS_MODULE,                           \
209                 },                                                      \
210                 .reg = MC13783_REG_ ## _reg,                            \
211                 .enable_bit = MC13783_REG_ ## _reg ## _ ## _name ## EN, \
212                 .voltages =  _voltages,                                 \
213         }
214
215 #define MC13783_GPO_DEFINE(prefix, _name, _reg,  _voltages)             \
216         [MC13783_ ## prefix ## _ ## _name] = {                          \
217                 .desc = {                                               \
218                         .name = #prefix "_" #_name,                     \
219                         .n_voltages = ARRAY_SIZE(_voltages),            \
220                         .ops = &mc13783_gpo_regulator_ops,              \
221                         .type = REGULATOR_VOLTAGE,                      \
222                         .id = MC13783_ ## prefix ## _ ## _name,         \
223                         .owner = THIS_MODULE,                           \
224                 },                                                      \
225                 .reg = MC13783_REG_ ## _reg,                            \
226                 .enable_bit = MC13783_REG_ ## _reg ## _ ## _name ## EN, \
227                 .voltages =  _voltages,                                 \
228         }
229
230 #define MC13783_DEFINE_SW(_name, _reg, _vsel_reg, _voltages)            \
231         MC13783_DEFINE(SW, _name, _reg, _vsel_reg, _voltages)
232 #define MC13783_DEFINE_REGU(_name, _reg, _vsel_reg, _voltages)          \
233         MC13783_DEFINE(REGU, _name, _reg, _vsel_reg, _voltages)
234
235 static struct mc13783_regulator mc13783_regulators[] = {
236         MC13783_DEFINE_SW(SW3, SWITCHERS5, SWITCHERS5, mc13783_sw3_val),
237
238         MC13783_FIXED_DEFINE(REGU, VAUDIO, REGULATORMODE0, mc13783_vaudio_val),
239         MC13783_FIXED_DEFINE(REGU, VIOHI, REGULATORMODE0, mc13783_viohi_val),
240         MC13783_DEFINE_REGU(VIOLO, REGULATORMODE0, REGULATORSETTING0,   \
241                             mc13783_violo_val),
242         MC13783_DEFINE_REGU(VDIG, REGULATORMODE0, REGULATORSETTING0,    \
243                             mc13783_vdig_val),
244         MC13783_DEFINE_REGU(VGEN, REGULATORMODE0, REGULATORSETTING0,    \
245                             mc13783_vgen_val),
246         MC13783_DEFINE_REGU(VRFDIG, REGULATORMODE0, REGULATORSETTING0,  \
247                             mc13783_vrfdig_val),
248         MC13783_DEFINE_REGU(VRFREF, REGULATORMODE0, REGULATORSETTING0,  \
249                             mc13783_vrfref_val),
250         MC13783_DEFINE_REGU(VRFCP, REGULATORMODE0, REGULATORSETTING0,   \
251                             mc13783_vrfcp_val),
252         MC13783_DEFINE_REGU(VSIM, REGULATORMODE1, REGULATORSETTING0,    \
253                             mc13783_vsim_val),
254         MC13783_DEFINE_REGU(VESIM, REGULATORMODE1, REGULATORSETTING0,   \
255                             mc13783_vesim_val),
256         MC13783_DEFINE_REGU(VCAM, REGULATORMODE1, REGULATORSETTING0,    \
257                             mc13783_vcam_val),
258         MC13783_FIXED_DEFINE(REGU, VRFBG, REGULATORMODE1, mc13783_vrfbg_val),
259         MC13783_DEFINE_REGU(VVIB, REGULATORMODE1, REGULATORSETTING1,    \
260                             mc13783_vvib_val),
261         MC13783_DEFINE_REGU(VRF1, REGULATORMODE1, REGULATORSETTING1,    \
262                             mc13783_vrf_val),
263         MC13783_DEFINE_REGU(VRF2, REGULATORMODE1, REGULATORSETTING1,    \
264                             mc13783_vrf_val),
265         MC13783_DEFINE_REGU(VMMC1, REGULATORMODE1, REGULATORSETTING1,   \
266                             mc13783_vmmc_val),
267         MC13783_DEFINE_REGU(VMMC2, REGULATORMODE1, REGULATORSETTING1,   \
268                             mc13783_vmmc_val),
269         MC13783_GPO_DEFINE(REGU, GPO1, POWERMISC, mc13783_gpo_val),
270         MC13783_GPO_DEFINE(REGU, GPO2, POWERMISC, mc13783_gpo_val),
271         MC13783_GPO_DEFINE(REGU, GPO3, POWERMISC, mc13783_gpo_val),
272         MC13783_GPO_DEFINE(REGU, GPO4, POWERMISC, mc13783_gpo_val),
273         MC13783_GPO_DEFINE(REGU, PWGT1SPI, POWERMISC, mc13783_pwgtdrv_val),
274         MC13783_GPO_DEFINE(REGU, PWGT2SPI, POWERMISC, mc13783_pwgtdrv_val),
275 };
276
277 struct mc13783_regulator_priv {
278         struct mc13783 *mc13783;
279         u32 powermisc_pwgt_state;
280         struct regulator_dev *regulators[];
281 };
282
283 static int mc13783_regulator_enable(struct regulator_dev *rdev)
284 {
285         struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev);
286         int id = rdev_get_id(rdev);
287         int ret;
288
289         dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
290
291         mc13783_lock(priv->mc13783);
292         ret = mc13783_reg_rmw(priv->mc13783, mc13783_regulators[id].reg,
293                         mc13783_regulators[id].enable_bit,
294                         mc13783_regulators[id].enable_bit);
295         mc13783_unlock(priv->mc13783);
296
297         return ret;
298 }
299
300 static int mc13783_regulator_disable(struct regulator_dev *rdev)
301 {
302         struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev);
303         int id = rdev_get_id(rdev);
304         int ret;
305
306         dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
307
308         mc13783_lock(priv->mc13783);
309         ret = mc13783_reg_rmw(priv->mc13783, mc13783_regulators[id].reg,
310                         mc13783_regulators[id].enable_bit, 0);
311         mc13783_unlock(priv->mc13783);
312
313         return ret;
314 }
315
316 static int mc13783_regulator_is_enabled(struct regulator_dev *rdev)
317 {
318         struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev);
319         int ret, id = rdev_get_id(rdev);
320         unsigned int val;
321
322         mc13783_lock(priv->mc13783);
323         ret = mc13783_reg_read(priv->mc13783, mc13783_regulators[id].reg, &val);
324         mc13783_unlock(priv->mc13783);
325
326         if (ret)
327                 return ret;
328
329         return (val & mc13783_regulators[id].enable_bit) != 0;
330 }
331
332 static int mc13783_regulator_list_voltage(struct regulator_dev *rdev,
333                                                 unsigned selector)
334 {
335         int id = rdev_get_id(rdev);
336
337         if (selector >= mc13783_regulators[id].desc.n_voltages)
338                 return -EINVAL;
339
340         return mc13783_regulators[id].voltages[selector];
341 }
342
343 static int mc13783_get_best_voltage_index(struct regulator_dev *rdev,
344                                                 int min_uV, int max_uV)
345 {
346         int reg_id = rdev_get_id(rdev);
347         int i;
348         int bestmatch;
349         int bestindex;
350
351         /*
352          * Locate the minimum voltage fitting the criteria on
353          * this regulator. The switchable voltages are not
354          * in strict falling order so we need to check them
355          * all for the best match.
356          */
357         bestmatch = INT_MAX;
358         bestindex = -1;
359         for (i = 0; i < mc13783_regulators[reg_id].desc.n_voltages; i++) {
360                 if (mc13783_regulators[reg_id].voltages[i] >= min_uV &&
361                     mc13783_regulators[reg_id].voltages[i] < bestmatch) {
362                         bestmatch = mc13783_regulators[reg_id].voltages[i];
363                         bestindex = i;
364                 }
365         }
366
367         if (bestindex < 0 || bestmatch > max_uV) {
368                 dev_warn(&rdev->dev, "no possible value for %d<=x<=%d uV\n",
369                                 min_uV, max_uV);
370                 return -EINVAL;
371         }
372         return bestindex;
373 }
374
375 static int mc13783_regulator_set_voltage(struct regulator_dev *rdev,
376                                                 int min_uV, int max_uV)
377 {
378         struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev);
379         int value, id = rdev_get_id(rdev);
380         int ret;
381
382         dev_dbg(rdev_get_dev(rdev), "%s id: %d min_uV: %d max_uV: %d\n",
383                 __func__, id, min_uV, max_uV);
384
385         /* Find the best index */
386         value = mc13783_get_best_voltage_index(rdev, min_uV, max_uV);
387         dev_dbg(rdev_get_dev(rdev), "%s best value: %d \n", __func__, value);
388         if (value < 0)
389                 return value;
390
391         mc13783_lock(priv->mc13783);
392         ret = mc13783_reg_rmw(priv->mc13783, mc13783_regulators[id].vsel_reg,
393                         mc13783_regulators[id].vsel_mask,
394                         value << mc13783_regulators[id].vsel_shift);
395         mc13783_unlock(priv->mc13783);
396
397         return ret;
398 }
399
400 static int mc13783_regulator_get_voltage(struct regulator_dev *rdev)
401 {
402         struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev);
403         int ret, id = rdev_get_id(rdev);
404         unsigned int val;
405
406         dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
407
408         mc13783_lock(priv->mc13783);
409         ret = mc13783_reg_read(priv->mc13783,
410                                 mc13783_regulators[id].vsel_reg, &val);
411         mc13783_unlock(priv->mc13783);
412
413         if (ret)
414                 return ret;
415
416         val = (val & mc13783_regulators[id].vsel_mask)
417                 >> mc13783_regulators[id].vsel_shift;
418
419         dev_dbg(rdev_get_dev(rdev), "%s id: %d val: %d\n", __func__, id, val);
420
421         BUG_ON(val < 0 || val > mc13783_regulators[id].desc.n_voltages);
422
423         return mc13783_regulators[id].voltages[val];
424 }
425
426 static struct regulator_ops mc13783_regulator_ops = {
427         .enable = mc13783_regulator_enable,
428         .disable = mc13783_regulator_disable,
429         .is_enabled = mc13783_regulator_is_enabled,
430         .list_voltage = mc13783_regulator_list_voltage,
431         .set_voltage = mc13783_regulator_set_voltage,
432         .get_voltage = mc13783_regulator_get_voltage,
433 };
434
435 static int mc13783_fixed_regulator_set_voltage(struct regulator_dev *rdev,
436                                                 int min_uV, int max_uV)
437 {
438         int id = rdev_get_id(rdev);
439
440         dev_dbg(rdev_get_dev(rdev), "%s id: %d min_uV: %d max_uV: %d\n",
441                 __func__, id, min_uV, max_uV);
442
443         if (min_uV >= mc13783_regulators[id].voltages[0] &&
444             max_uV <= mc13783_regulators[id].voltages[0])
445                 return 0;
446         else
447                 return -EINVAL;
448 }
449
450 static int mc13783_fixed_regulator_get_voltage(struct regulator_dev *rdev)
451 {
452         int id = rdev_get_id(rdev);
453
454         dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
455
456         return mc13783_regulators[id].voltages[0];
457 }
458
459 static struct regulator_ops mc13783_fixed_regulator_ops = {
460         .enable = mc13783_regulator_enable,
461         .disable = mc13783_regulator_disable,
462         .is_enabled = mc13783_regulator_is_enabled,
463         .list_voltage = mc13783_regulator_list_voltage,
464         .set_voltage = mc13783_fixed_regulator_set_voltage,
465         .get_voltage = mc13783_fixed_regulator_get_voltage,
466 };
467
468 int mc13783_powermisc_rmw(struct mc13783_regulator_priv *priv, u32 mask,
469                                                                         u32 val)
470 {
471         struct mc13783 *mc13783 = priv->mc13783;
472         int ret;
473         u32 valread;
474
475         BUG_ON(val & ~mask);
476
477         ret = mc13783_reg_read(mc13783, MC13783_REG_POWERMISC, &valread);
478         if (ret)
479                 return ret;
480
481         /* Update the stored state for Power Gates. */
482         priv->powermisc_pwgt_state =
483                                 (priv->powermisc_pwgt_state & ~mask) | val;
484         priv->powermisc_pwgt_state &= MC13783_REG_POWERMISC_PWGTSPI_M;
485
486         /* Construct the new register value */
487         valread = (valread & ~mask) | val;
488         /* Overwrite the PWGTxEN with the stored version */
489         valread = (valread & ~MC13783_REG_POWERMISC_PWGTSPI_M) |
490                                                 priv->powermisc_pwgt_state;
491
492         return mc13783_reg_write(mc13783, MC13783_REG_POWERMISC, valread);
493 }
494
495 static int mc13783_gpo_regulator_enable(struct regulator_dev *rdev)
496 {
497         struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev);
498         int id = rdev_get_id(rdev);
499         int ret;
500         u32 en_val = mc13783_regulators[id].enable_bit;
501
502         dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
503
504         /* Power Gate enable value is 0 */
505         if (id == MC13783_REGU_PWGT1SPI ||
506             id == MC13783_REGU_PWGT2SPI)
507                 en_val = 0;
508
509         mc13783_lock(priv->mc13783);
510         ret = mc13783_powermisc_rmw(priv, mc13783_regulators[id].enable_bit,
511                                         en_val);
512         mc13783_unlock(priv->mc13783);
513
514         return ret;
515 }
516
517 static int mc13783_gpo_regulator_disable(struct regulator_dev *rdev)
518 {
519         struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev);
520         int id = rdev_get_id(rdev);
521         int ret;
522         u32 dis_val = 0;
523
524         dev_dbg(rdev_get_dev(rdev), "%s id: %d\n", __func__, id);
525
526         /* Power Gate disable value is 1 */
527         if (id == MC13783_REGU_PWGT1SPI ||
528             id == MC13783_REGU_PWGT2SPI)
529                 dis_val = mc13783_regulators[id].enable_bit;
530
531         mc13783_lock(priv->mc13783);
532         ret = mc13783_powermisc_rmw(priv, mc13783_regulators[id].enable_bit,
533                                         dis_val);
534         mc13783_unlock(priv->mc13783);
535
536         return ret;
537 }
538
539 static int mc13783_gpo_regulator_is_enabled(struct regulator_dev *rdev)
540 {
541         struct mc13783_regulator_priv *priv = rdev_get_drvdata(rdev);
542         int ret, id = rdev_get_id(rdev);
543         unsigned int val;
544
545         mc13783_lock(priv->mc13783);
546         ret = mc13783_reg_read(priv->mc13783, mc13783_regulators[id].reg, &val);
547         mc13783_unlock(priv->mc13783);
548
549         if (ret)
550                 return ret;
551
552         /* Power Gates state is stored in powermisc_pwgt_state
553          * where the meaning of bits is negated */
554         val = (val & ~MC13783_REG_POWERMISC_PWGTSPI_M) |
555               (priv->powermisc_pwgt_state ^ MC13783_REG_POWERMISC_PWGTSPI_M);
556
557         return (val & mc13783_regulators[id].enable_bit) != 0;
558 }
559
560 static struct regulator_ops mc13783_gpo_regulator_ops = {
561         .enable = mc13783_gpo_regulator_enable,
562         .disable = mc13783_gpo_regulator_disable,
563         .is_enabled = mc13783_gpo_regulator_is_enabled,
564         .list_voltage = mc13783_regulator_list_voltage,
565         .set_voltage = mc13783_fixed_regulator_set_voltage,
566         .get_voltage = mc13783_fixed_regulator_get_voltage,
567 };
568
569 static int __devinit mc13783_regulator_probe(struct platform_device *pdev)
570 {
571         struct mc13783_regulator_priv *priv;
572         struct mc13783 *mc13783 = dev_get_drvdata(pdev->dev.parent);
573         struct mc13783_regulator_platform_data *pdata =
574                 dev_get_platdata(&pdev->dev);
575         struct mc13783_regulator_init_data *init_data;
576         int i, ret;
577
578         dev_dbg(&pdev->dev, "mc13783_regulator_probe id %d\n", pdev->id);
579
580         priv = kzalloc(sizeof(*priv) +
581                         pdata->num_regulators * sizeof(priv->regulators[0]),
582                         GFP_KERNEL);
583         if (!priv)
584                 return -ENOMEM;
585
586         priv->mc13783 = mc13783;
587
588         for (i = 0; i < pdata->num_regulators; i++) {
589                 init_data = &pdata->regulators[i];
590                 priv->regulators[i] = regulator_register(
591                                 &mc13783_regulators[init_data->id].desc,
592                                 &pdev->dev, init_data->init_data, priv);
593
594                 if (IS_ERR(priv->regulators[i])) {
595                         dev_err(&pdev->dev, "failed to register regulator %s\n",
596                                 mc13783_regulators[i].desc.name);
597                         ret = PTR_ERR(priv->regulators[i]);
598                         goto err;
599                 }
600         }
601
602         platform_set_drvdata(pdev, priv);
603
604         return 0;
605 err:
606         while (--i >= 0)
607                 regulator_unregister(priv->regulators[i]);
608
609         kfree(priv);
610
611         return ret;
612 }
613
614 static int __devexit mc13783_regulator_remove(struct platform_device *pdev)
615 {
616         struct mc13783_regulator_priv *priv = platform_get_drvdata(pdev);
617         struct mc13783_regulator_platform_data *pdata =
618                 dev_get_platdata(&pdev->dev);
619         int i;
620
621         platform_set_drvdata(pdev, NULL);
622
623         for (i = 0; i < pdata->num_regulators; i++)
624                 regulator_unregister(priv->regulators[i]);
625
626         kfree(priv);
627         return 0;
628 }
629
630 static struct platform_driver mc13783_regulator_driver = {
631         .driver = {
632                 .name   = "mc13783-regulator",
633                 .owner  = THIS_MODULE,
634         },
635         .remove         = __devexit_p(mc13783_regulator_remove),
636         .probe          = mc13783_regulator_probe,
637 };
638
639 static int __init mc13783_regulator_init(void)
640 {
641         return platform_driver_register(&mc13783_regulator_driver);
642 }
643 subsys_initcall(mc13783_regulator_init);
644
645 static void __exit mc13783_regulator_exit(void)
646 {
647         platform_driver_unregister(&mc13783_regulator_driver);
648 }
649 module_exit(mc13783_regulator_exit);
650
651 MODULE_LICENSE("GPL v2");
652 MODULE_AUTHOR("Sascha Hauer <s.hauer@pengutronix.de>");
653 MODULE_DESCRIPTION("Regulator Driver for Freescale MC13783 PMIC");
654 MODULE_ALIAS("platform:mc13783-regulator");