regulator: Pass regulator init data as explict argument when registering
[linux-2.6.git] / drivers / regulator / wm8400-regulator.c
1 /*
2  * Regulator support for WM8400
3  *
4  * Copyright 2008 Wolfson Microelectronics PLC.
5  *
6  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of the
11  * License, or (at your option) any later version.
12  *
13  */
14
15 #include <linux/bug.h>
16 #include <linux/err.h>
17 #include <linux/kernel.h>
18 #include <linux/regulator/driver.h>
19 #include <linux/mfd/wm8400-private.h>
20
21 static int wm8400_ldo_is_enabled(struct regulator_dev *dev)
22 {
23         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
24         u16 val;
25
26         val = wm8400_reg_read(wm8400, WM8400_LDO1_CONTROL + rdev_get_id(dev));
27         return (val & WM8400_LDO1_ENA) != 0;
28 }
29
30 static int wm8400_ldo_enable(struct regulator_dev *dev)
31 {
32         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
33
34         return wm8400_set_bits(wm8400, WM8400_LDO1_CONTROL + rdev_get_id(dev),
35                                WM8400_LDO1_ENA, WM8400_LDO1_ENA);
36 }
37
38 static int wm8400_ldo_disable(struct regulator_dev *dev)
39 {
40         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
41
42         return wm8400_set_bits(wm8400, WM8400_LDO1_CONTROL + rdev_get_id(dev),
43                                WM8400_LDO1_ENA, 0);
44 }
45
46 static int wm8400_ldo_get_voltage(struct regulator_dev *dev)
47 {
48         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
49         u16 val;
50
51         val = wm8400_reg_read(wm8400, WM8400_LDO1_CONTROL + rdev_get_id(dev));
52         val &= WM8400_LDO1_VSEL_MASK;
53
54         if (val < 15)
55                 return 900000 + (val * 50000);
56         else
57                 return 1600000 + ((val - 14) * 100000);
58 }
59
60 static int wm8400_ldo_set_voltage(struct regulator_dev *dev,
61                                   int min_uV, int max_uV)
62 {
63         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
64         u16 val;
65
66         if (min_uV < 900000 || min_uV > 3300000)
67                 return -EINVAL;
68
69         if (min_uV < 1700000) {
70                 /* Steps of 50mV from 900mV;  */
71                 val = (min_uV - 850001) / 50000;
72
73                 if ((val * 50000) + 900000 > max_uV)
74                         return -EINVAL;
75                 BUG_ON((val * 50000) + 900000 < min_uV);
76         } else {
77                 /* Steps of 100mV from 1700mV */
78                 val = ((min_uV - 1600001) / 100000);
79
80                 if ((val * 100000) + 1700000 > max_uV)
81                         return -EINVAL;
82                 BUG_ON((val * 100000) + 1700000 < min_uV);
83
84                 val += 0xf;
85         }
86
87         return wm8400_set_bits(wm8400, WM8400_LDO1_CONTROL + rdev_get_id(dev),
88                                WM8400_LDO1_VSEL_MASK, val);
89 }
90
91 static struct regulator_ops wm8400_ldo_ops = {
92         .is_enabled = wm8400_ldo_is_enabled,
93         .enable = wm8400_ldo_enable,
94         .disable = wm8400_ldo_disable,
95         .get_voltage = wm8400_ldo_get_voltage,
96         .set_voltage = wm8400_ldo_set_voltage,
97 };
98
99 static int wm8400_dcdc_is_enabled(struct regulator_dev *dev)
100 {
101         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
102         int offset = (rdev_get_id(dev) - WM8400_DCDC1) * 2;
103         u16 val;
104
105         val = wm8400_reg_read(wm8400, WM8400_DCDC1_CONTROL_1 + offset);
106         return (val & WM8400_DC1_ENA) != 0;
107 }
108
109 static int wm8400_dcdc_enable(struct regulator_dev *dev)
110 {
111         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
112         int offset = (rdev_get_id(dev) - WM8400_DCDC1) * 2;
113
114         return wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_1 + offset,
115                                WM8400_DC1_ENA, WM8400_DC1_ENA);
116 }
117
118 static int wm8400_dcdc_disable(struct regulator_dev *dev)
119 {
120         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
121         int offset = (rdev_get_id(dev) - WM8400_DCDC1) * 2;
122
123         return wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_1 + offset,
124                                WM8400_DC1_ENA, 0);
125 }
126
127 static int wm8400_dcdc_get_voltage(struct regulator_dev *dev)
128 {
129         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
130         u16 val;
131         int offset = (rdev_get_id(dev) - WM8400_DCDC1) * 2;
132
133         val = wm8400_reg_read(wm8400, WM8400_DCDC1_CONTROL_1 + offset);
134         val &= WM8400_DC1_VSEL_MASK;
135
136         return 850000 + (25000 * val);
137 }
138
139 static int wm8400_dcdc_set_voltage(struct regulator_dev *dev,
140                                   int min_uV, int max_uV)
141 {
142         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
143         u16 val;
144         int offset = (rdev_get_id(dev) - WM8400_DCDC1) * 2;
145
146         if (min_uV < 850000)
147                 return -EINVAL;
148
149         val = (min_uV - 825001) / 25000;
150
151         if (850000 + (25000 * val) > max_uV)
152                 return -EINVAL;
153         BUG_ON(850000 + (25000 * val) < min_uV);
154
155         return wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_1 + offset,
156                                WM8400_DC1_VSEL_MASK, val);
157 }
158
159 static unsigned int wm8400_dcdc_get_mode(struct regulator_dev *dev)
160 {
161         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
162         int offset = (rdev_get_id(dev) - WM8400_DCDC1) * 2;
163         u16 data[2];
164         int ret;
165
166         ret = wm8400_block_read(wm8400, WM8400_DCDC1_CONTROL_1 + offset, 2,
167                                 data);
168         if (ret != 0)
169                 return 0;
170
171         /* Datasheet: hibernate */
172         if (data[0] & WM8400_DC1_SLEEP)
173                 return REGULATOR_MODE_STANDBY;
174
175         /* Datasheet: standby */
176         if (!(data[0] & WM8400_DC1_ACTIVE))
177                 return REGULATOR_MODE_IDLE;
178
179         /* Datasheet: active with or without force PWM */
180         if (data[1] & WM8400_DC1_FRC_PWM)
181                 return REGULATOR_MODE_FAST;
182         else
183                 return REGULATOR_MODE_NORMAL;
184 }
185
186 static int wm8400_dcdc_set_mode(struct regulator_dev *dev, unsigned int mode)
187 {
188         struct wm8400 *wm8400 = rdev_get_drvdata(dev);
189         int offset = (rdev_get_id(dev) - WM8400_DCDC1) * 2;
190         int ret;
191
192         switch (mode) {
193         case REGULATOR_MODE_FAST:
194                 /* Datasheet: active with force PWM */
195                 ret = wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_2 + offset,
196                                       WM8400_DC1_FRC_PWM, WM8400_DC1_FRC_PWM);
197                 if (ret != 0)
198                         return ret;
199
200                 return wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_1 + offset,
201                                        WM8400_DC1_ACTIVE | WM8400_DC1_SLEEP,
202                                        WM8400_DC1_ACTIVE);
203
204         case REGULATOR_MODE_NORMAL:
205                 /* Datasheet: active */
206                 ret = wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_2 + offset,
207                                       WM8400_DC1_FRC_PWM, 0);
208                 if (ret != 0)
209                         return ret;
210
211                 return wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_1 + offset,
212                                        WM8400_DC1_ACTIVE | WM8400_DC1_SLEEP,
213                                        WM8400_DC1_ACTIVE);
214
215         case REGULATOR_MODE_IDLE:
216                 /* Datasheet: standby */
217                 ret = wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_1 + offset,
218                                       WM8400_DC1_ACTIVE, 0);
219                 if (ret != 0)
220                         return ret;
221                 return wm8400_set_bits(wm8400, WM8400_DCDC1_CONTROL_1 + offset,
222                                        WM8400_DC1_SLEEP, 0);
223
224         default:
225                 return -EINVAL;
226         }
227 }
228
229 static unsigned int wm8400_dcdc_get_optimum_mode(struct regulator_dev *dev,
230                                                  int input_uV, int output_uV,
231                                                  int load_uA)
232 {
233         return REGULATOR_MODE_NORMAL;
234 }
235
236 static struct regulator_ops wm8400_dcdc_ops = {
237         .is_enabled = wm8400_dcdc_is_enabled,
238         .enable = wm8400_dcdc_enable,
239         .disable = wm8400_dcdc_disable,
240         .get_voltage = wm8400_dcdc_get_voltage,
241         .set_voltage = wm8400_dcdc_set_voltage,
242         .get_mode = wm8400_dcdc_get_mode,
243         .set_mode = wm8400_dcdc_set_mode,
244         .get_optimum_mode = wm8400_dcdc_get_optimum_mode,
245 };
246
247 static struct regulator_desc regulators[] = {
248         {
249                 .name = "LDO1",
250                 .id = WM8400_LDO1,
251                 .ops = &wm8400_ldo_ops,
252                 .type = REGULATOR_VOLTAGE,
253                 .owner = THIS_MODULE,
254         },
255         {
256                 .name = "LDO2",
257                 .id = WM8400_LDO2,
258                 .ops = &wm8400_ldo_ops,
259                 .type = REGULATOR_VOLTAGE,
260                 .owner = THIS_MODULE,
261         },
262         {
263                 .name = "LDO3",
264                 .id = WM8400_LDO3,
265                 .ops = &wm8400_ldo_ops,
266                 .type = REGULATOR_VOLTAGE,
267                 .owner = THIS_MODULE,
268         },
269         {
270                 .name = "LDO4",
271                 .id = WM8400_LDO4,
272                 .ops = &wm8400_ldo_ops,
273                 .type = REGULATOR_VOLTAGE,
274                 .owner = THIS_MODULE,
275         },
276         {
277                 .name = "DCDC1",
278                 .id = WM8400_DCDC1,
279                 .ops = &wm8400_dcdc_ops,
280                 .type = REGULATOR_VOLTAGE,
281                 .owner = THIS_MODULE,
282         },
283         {
284                 .name = "DCDC2",
285                 .id = WM8400_DCDC2,
286                 .ops = &wm8400_dcdc_ops,
287                 .type = REGULATOR_VOLTAGE,
288                 .owner = THIS_MODULE,
289         },
290 };
291
292 static int __devinit wm8400_regulator_probe(struct platform_device *pdev)
293 {
294         struct regulator_dev *rdev;
295
296         rdev = regulator_register(&regulators[pdev->id], &pdev->dev,
297                 pdev->dev.platform_data, pdev->dev.driver_data);
298
299         if (IS_ERR(rdev))
300                 return PTR_ERR(rdev);
301
302         return 0;
303 }
304
305 static int __devexit wm8400_regulator_remove(struct platform_device *pdev)
306 {
307         struct regulator_dev *rdev = platform_get_drvdata(pdev);
308
309         regulator_unregister(rdev);
310
311         return 0;
312 }
313
314 static struct platform_driver wm8400_regulator_driver = {
315         .driver = {
316                 .name = "wm8400-regulator",
317         },
318         .probe = wm8400_regulator_probe,
319         .remove = __devexit_p(wm8400_regulator_remove),
320 };
321
322 /**
323  * wm8400_register_regulator - enable software control of a WM8400 regulator
324  *
325  * This function enables software control of a WM8400 regulator via
326  * the regulator API.  It is intended to be called from the
327  * platform_init() callback of the WM8400 MFD driver.
328  *
329  * @param dev      The WM8400 device to operate on.
330  * @param reg      The regulator to control.
331  * @param initdata Regulator initdata for the regulator.
332  */
333 int wm8400_register_regulator(struct device *dev, int reg,
334                               struct regulator_init_data *initdata)
335 {
336         struct wm8400 *wm8400 = dev->driver_data;
337
338         if (wm8400->regulators[reg].name)
339                 return -EBUSY;
340
341         initdata->driver_data = wm8400;
342
343         wm8400->regulators[reg].name = "wm8400-regulator";
344         wm8400->regulators[reg].id = reg;
345         wm8400->regulators[reg].dev.parent = dev;
346         wm8400->regulators[reg].dev.driver_data = wm8400;
347         wm8400->regulators[reg].dev.platform_data = initdata;
348
349         return platform_device_register(&wm8400->regulators[reg]);
350 }
351 EXPORT_SYMBOL_GPL(wm8400_register_regulator);
352
353 static int __init wm8400_regulator_init(void)
354 {
355         return platform_driver_register(&wm8400_regulator_driver);
356 }
357 module_init(wm8400_regulator_init);
358
359 static void __exit wm8400_regulator_exit(void)
360 {
361         platform_driver_unregister(&wm8400_regulator_driver);
362 }
363 module_exit(wm8400_regulator_exit);
364
365 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
366 MODULE_DESCRIPTION("WM8400 regulator driver");
367 MODULE_LICENSE("GPL");
368 MODULE_ALIAS("platform:wm8400-regulator");