blob: 56a6de3dd8834022fd68add8feea2fa43ce283f2 [file] [log] [blame]
Mark Brownd1c6b4f2009-07-28 15:22:02 +01001/*
2 * wm831x-ldo.c -- LDO driver for the WM831x series
3 *
4 * Copyright 2009 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 modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
12 */
13
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/init.h>
17#include <linux/bitops.h>
18#include <linux/err.h>
19#include <linux/i2c.h>
20#include <linux/platform_device.h>
21#include <linux/regulator/driver.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090022#include <linux/slab.h>
Mark Brownd1c6b4f2009-07-28 15:22:02 +010023
24#include <linux/mfd/wm831x/core.h>
25#include <linux/mfd/wm831x/regulator.h>
26#include <linux/mfd/wm831x/pdata.h>
27
Mark Brownf1aba132012-03-28 21:40:20 +010028#define WM831X_LDO_MAX_NAME 9
Mark Brownd1c6b4f2009-07-28 15:22:02 +010029
30#define WM831X_LDO_CONTROL 0
31#define WM831X_LDO_ON_CONTROL 1
32#define WM831X_LDO_SLEEP_CONTROL 2
33
34#define WM831X_ALIVE_LDO_ON_CONTROL 0
35#define WM831X_ALIVE_LDO_SLEEP_CONTROL 1
36
37struct wm831x_ldo {
38 char name[WM831X_LDO_MAX_NAME];
Mark Brownf1aba132012-03-28 21:40:20 +010039 char supply_name[WM831X_LDO_MAX_NAME];
Mark Brownd1c6b4f2009-07-28 15:22:02 +010040 struct regulator_desc desc;
41 int base;
42 struct wm831x *wm831x;
43 struct regulator_dev *regulator;
44};
45
46/*
47 * Shared
48 */
49
Mark Brownd1c6b4f2009-07-28 15:22:02 +010050static irqreturn_t wm831x_ldo_uv_irq(int irq, void *data)
51{
52 struct wm831x_ldo *ldo = data;
53
54 regulator_notifier_call_chain(ldo->regulator,
55 REGULATOR_EVENT_UNDER_VOLTAGE,
56 NULL);
57
58 return IRQ_HANDLED;
59}
60
61/*
62 * General purpose LDOs
63 */
64
65#define WM831X_GP_LDO_SELECTOR_LOW 0xe
66#define WM831X_GP_LDO_MAX_SELECTOR 0x1f
67
68static int wm831x_gp_ldo_list_voltage(struct regulator_dev *rdev,
69 unsigned int selector)
70{
71 /* 0.9-1.6V in 50mV steps */
72 if (selector <= WM831X_GP_LDO_SELECTOR_LOW)
73 return 900000 + (selector * 50000);
Axel Lin6085d4d2012-03-29 15:04:22 +080074 /* 1.7-3.3V in 100mV steps */
Mark Brownd1c6b4f2009-07-28 15:22:02 +010075 if (selector <= WM831X_GP_LDO_MAX_SELECTOR)
76 return 1600000 + ((selector - WM831X_GP_LDO_SELECTOR_LOW)
77 * 100000);
78 return -EINVAL;
79}
80
Axel Lin0a479682012-06-12 10:46:43 +080081static int wm831x_gp_ldo_map_voltage(struct regulator_dev *rdev,
82 int min_uV, int max_uV)
Mark Brownd1c6b4f2009-07-28 15:22:02 +010083{
Axel Lin0a479682012-06-12 10:46:43 +080084 int volt, vsel;
Mark Brownd1c6b4f2009-07-28 15:22:02 +010085
86 if (min_uV < 900000)
87 vsel = 0;
88 else if (min_uV < 1700000)
89 vsel = ((min_uV - 900000) / 50000);
90 else
91 vsel = ((min_uV - 1700000) / 100000)
92 + WM831X_GP_LDO_SELECTOR_LOW + 1;
93
Axel Lin0a479682012-06-12 10:46:43 +080094 volt = wm831x_gp_ldo_list_voltage(rdev, vsel);
95 if (volt < min_uV || volt > max_uV)
Mark Brownd1c6b4f2009-07-28 15:22:02 +010096 return -EINVAL;
97
Axel Lin0a479682012-06-12 10:46:43 +080098 return vsel;
Mark Brownd1c6b4f2009-07-28 15:22:02 +010099}
100
101static int wm831x_gp_ldo_set_suspend_voltage(struct regulator_dev *rdev,
102 int uV)
103{
104 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
Axel Lin0a479682012-06-12 10:46:43 +0800105 struct wm831x *wm831x = ldo->wm831x;
106 int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100107
Axel Lin0a479682012-06-12 10:46:43 +0800108 sel = wm831x_gp_ldo_map_voltage(rdev, uV, uV);
109 if (sel < 0)
110 return sel;
111
112 return wm831x_set_bits(wm831x, reg, WM831X_LDO1_ON_VSEL_MASK, sel);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100113}
114
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100115static unsigned int wm831x_gp_ldo_get_mode(struct regulator_dev *rdev)
116{
117 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
118 struct wm831x *wm831x = ldo->wm831x;
119 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
120 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
Roel Kluin9a767d42009-10-16 14:16:15 +0200121 int ret;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100122
123 ret = wm831x_reg_read(wm831x, on_reg);
124 if (ret < 0)
Roel Kluin9a767d42009-10-16 14:16:15 +0200125 return ret;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100126
127 if (!(ret & WM831X_LDO1_ON_MODE))
128 return REGULATOR_MODE_NORMAL;
129
130 ret = wm831x_reg_read(wm831x, ctrl_reg);
131 if (ret < 0)
Roel Kluin9a767d42009-10-16 14:16:15 +0200132 return ret;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100133
134 if (ret & WM831X_LDO1_LP_MODE)
135 return REGULATOR_MODE_STANDBY;
136 else
137 return REGULATOR_MODE_IDLE;
138}
139
140static int wm831x_gp_ldo_set_mode(struct regulator_dev *rdev,
141 unsigned int mode)
142{
143 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
144 struct wm831x *wm831x = ldo->wm831x;
145 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
146 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
147 int ret;
148
149
150 switch (mode) {
151 case REGULATOR_MODE_NORMAL:
152 ret = wm831x_set_bits(wm831x, on_reg,
153 WM831X_LDO1_ON_MODE, 0);
154 if (ret < 0)
155 return ret;
156 break;
157
158 case REGULATOR_MODE_IDLE:
159 ret = wm831x_set_bits(wm831x, ctrl_reg,
Axel Line2609992010-09-06 16:48:13 +0800160 WM831X_LDO1_LP_MODE, 0);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100161 if (ret < 0)
162 return ret;
163
164 ret = wm831x_set_bits(wm831x, on_reg,
165 WM831X_LDO1_ON_MODE,
166 WM831X_LDO1_ON_MODE);
167 if (ret < 0)
168 return ret;
Axel Line2609992010-09-06 16:48:13 +0800169 break;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100170
171 case REGULATOR_MODE_STANDBY:
172 ret = wm831x_set_bits(wm831x, ctrl_reg,
Axel Line2609992010-09-06 16:48:13 +0800173 WM831X_LDO1_LP_MODE,
174 WM831X_LDO1_LP_MODE);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100175 if (ret < 0)
176 return ret;
177
178 ret = wm831x_set_bits(wm831x, on_reg,
179 WM831X_LDO1_ON_MODE,
180 WM831X_LDO1_ON_MODE);
181 if (ret < 0)
182 return ret;
183 break;
184
185 default:
186 return -EINVAL;
187 }
188
189 return 0;
190}
191
192static int wm831x_gp_ldo_get_status(struct regulator_dev *rdev)
193{
194 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
195 struct wm831x *wm831x = ldo->wm831x;
196 int mask = 1 << rdev_get_id(rdev);
197 int ret;
198
199 /* Is the regulator on? */
200 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
201 if (ret < 0)
202 return ret;
203 if (!(ret & mask))
204 return REGULATOR_STATUS_OFF;
205
206 /* Is it reporting under voltage? */
207 ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
Axel Lin363506c2012-07-31 21:28:26 +0800208 if (ret < 0)
209 return ret;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100210 if (ret & mask)
211 return REGULATOR_STATUS_ERROR;
212
213 ret = wm831x_gp_ldo_get_mode(rdev);
214 if (ret < 0)
215 return ret;
216 else
217 return regulator_mode_to_status(ret);
218}
219
220static unsigned int wm831x_gp_ldo_get_optimum_mode(struct regulator_dev *rdev,
221 int input_uV,
222 int output_uV, int load_uA)
223{
224 if (load_uA < 20000)
225 return REGULATOR_MODE_STANDBY;
226 if (load_uA < 50000)
227 return REGULATOR_MODE_IDLE;
228 return REGULATOR_MODE_NORMAL;
229}
230
231
232static struct regulator_ops wm831x_gp_ldo_ops = {
233 .list_voltage = wm831x_gp_ldo_list_voltage,
Axel Lin0a479682012-06-12 10:46:43 +0800234 .map_voltage = wm831x_gp_ldo_map_voltage,
Mark Brownac663b42012-04-15 11:55:55 +0100235 .get_voltage_sel = regulator_get_voltage_sel_regmap,
Axel Lin0a479682012-06-12 10:46:43 +0800236 .set_voltage_sel = regulator_set_voltage_sel_regmap,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100237 .set_suspend_voltage = wm831x_gp_ldo_set_suspend_voltage,
238 .get_mode = wm831x_gp_ldo_get_mode,
239 .set_mode = wm831x_gp_ldo_set_mode,
240 .get_status = wm831x_gp_ldo_get_status,
241 .get_optimum_mode = wm831x_gp_ldo_get_optimum_mode,
242
Mark Brownca8c3612012-04-15 12:38:52 +0100243 .is_enabled = regulator_is_enabled_regmap,
244 .enable = regulator_enable_regmap,
245 .disable = regulator_disable_regmap,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100246};
247
248static __devinit int wm831x_gp_ldo_probe(struct platform_device *pdev)
249{
250 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
251 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
Mark Brownc1727082012-04-04 00:50:22 +0100252 struct regulator_config config = { };
Mark Brown137a6352011-07-25 22:20:29 +0100253 int id;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100254 struct wm831x_ldo *ldo;
255 struct resource *res;
256 int ret, irq;
257
Mark Brown137a6352011-07-25 22:20:29 +0100258 if (pdata && pdata->wm831x_num)
259 id = (pdata->wm831x_num * 10) + 1;
260 else
261 id = 0;
262 id = pdev->id - id;
263
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100264 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
265
Mark Brownfded2f42011-12-15 02:11:14 +0800266 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100267 if (ldo == NULL) {
268 dev_err(&pdev->dev, "Unable to allocate private data\n");
269 return -ENOMEM;
270 }
271
272 ldo->wm831x = wm831x;
273
274 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
275 if (res == NULL) {
276 dev_err(&pdev->dev, "No I/O resource\n");
277 ret = -EINVAL;
278 goto err;
279 }
280 ldo->base = res->start;
281
282 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
283 ldo->desc.name = ldo->name;
Mark Brownf1aba132012-03-28 21:40:20 +0100284
285 snprintf(ldo->supply_name, sizeof(ldo->supply_name),
286 "LDO%dVDD", id + 1);
287 ldo->desc.supply_name = ldo->supply_name;
288
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100289 ldo->desc.id = id;
290 ldo->desc.type = REGULATOR_VOLTAGE;
291 ldo->desc.n_voltages = WM831X_GP_LDO_MAX_SELECTOR + 1;
292 ldo->desc.ops = &wm831x_gp_ldo_ops;
293 ldo->desc.owner = THIS_MODULE;
Mark Brownac663b42012-04-15 11:55:55 +0100294 ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
295 ldo->desc.vsel_mask = WM831X_LDO1_ON_VSEL_MASK;
Mark Brownca8c3612012-04-15 12:38:52 +0100296 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
297 ldo->desc.enable_mask = 1 << id;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100298
Mark Brownc1727082012-04-04 00:50:22 +0100299 config.dev = pdev->dev.parent;
Mark Brownb7ca8782012-05-10 00:41:02 +0100300 if (pdata)
301 config.init_data = pdata->ldo[id];
Mark Brownc1727082012-04-04 00:50:22 +0100302 config.driver_data = ldo;
Mark Brownac663b42012-04-15 11:55:55 +0100303 config.regmap = wm831x->regmap;
Mark Brownc1727082012-04-04 00:50:22 +0100304
305 ldo->regulator = regulator_register(&ldo->desc, &config);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100306 if (IS_ERR(ldo->regulator)) {
307 ret = PTR_ERR(ldo->regulator);
308 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
309 id + 1, ret);
310 goto err;
311 }
312
Mark Browncd997582012-05-14 23:14:24 +0200313 irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
Mark Browndfda9c22011-03-01 16:50:43 +0000314 ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
315 IRQF_TRIGGER_RISING, ldo->name,
316 ldo);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100317 if (ret != 0) {
318 dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
319 irq, ret);
320 goto err_regulator;
321 }
322
323 platform_set_drvdata(pdev, ldo);
324
325 return 0;
326
327err_regulator:
328 regulator_unregister(ldo->regulator);
329err:
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100330 return ret;
331}
332
333static __devexit int wm831x_gp_ldo_remove(struct platform_device *pdev)
334{
335 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100336
Dmitry Torokhoveb66d562010-02-23 23:38:39 -0800337 platform_set_drvdata(pdev, NULL);
338
Mark Browncd997582012-05-14 23:14:24 +0200339 free_irq(wm831x_irq(ldo->wm831x,
340 platform_get_irq_byname(pdev, "UV")), ldo);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100341 regulator_unregister(ldo->regulator);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100342
343 return 0;
344}
345
346static struct platform_driver wm831x_gp_ldo_driver = {
347 .probe = wm831x_gp_ldo_probe,
348 .remove = __devexit_p(wm831x_gp_ldo_remove),
349 .driver = {
350 .name = "wm831x-ldo",
Dmitry Torokhoveb66d562010-02-23 23:38:39 -0800351 .owner = THIS_MODULE,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100352 },
353};
354
355/*
356 * Analogue LDOs
357 */
358
359
360#define WM831X_ALDO_SELECTOR_LOW 0xc
361#define WM831X_ALDO_MAX_SELECTOR 0x1f
362
363static int wm831x_aldo_list_voltage(struct regulator_dev *rdev,
364 unsigned int selector)
365{
366 /* 1-1.6V in 50mV steps */
367 if (selector <= WM831X_ALDO_SELECTOR_LOW)
368 return 1000000 + (selector * 50000);
Axel Lin6085d4d2012-03-29 15:04:22 +0800369 /* 1.7-3.5V in 100mV steps */
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100370 if (selector <= WM831X_ALDO_MAX_SELECTOR)
371 return 1600000 + ((selector - WM831X_ALDO_SELECTOR_LOW)
372 * 100000);
373 return -EINVAL;
374}
375
Axel Lin0a479682012-06-12 10:46:43 +0800376static int wm831x_aldo_map_voltage(struct regulator_dev *rdev,
377 int min_uV, int max_uV)
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100378{
Axel Lin0a479682012-06-12 10:46:43 +0800379 int volt, vsel;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100380
381 if (min_uV < 1000000)
382 vsel = 0;
383 else if (min_uV < 1700000)
384 vsel = ((min_uV - 1000000) / 50000);
385 else
386 vsel = ((min_uV - 1700000) / 100000)
387 + WM831X_ALDO_SELECTOR_LOW + 1;
388
Axel Lin0a479682012-06-12 10:46:43 +0800389 volt = wm831x_aldo_list_voltage(rdev, vsel);
390 if (volt < min_uV || volt > max_uV)
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100391 return -EINVAL;
392
Axel Lin0a479682012-06-12 10:46:43 +0800393 return vsel;
Mark Brown3a93f2a2010-11-10 14:38:29 +0000394
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100395}
396
397static int wm831x_aldo_set_suspend_voltage(struct regulator_dev *rdev,
398 int uV)
399{
400 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
Axel Lin0a479682012-06-12 10:46:43 +0800401 struct wm831x *wm831x = ldo->wm831x;
402 int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100403
Axel Lin0a479682012-06-12 10:46:43 +0800404 sel = wm831x_aldo_map_voltage(rdev, uV, uV);
405 if (sel < 0)
406 return sel;
407
408 return wm831x_set_bits(wm831x, reg, WM831X_LDO7_ON_VSEL_MASK, sel);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100409}
410
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100411static unsigned int wm831x_aldo_get_mode(struct regulator_dev *rdev)
412{
413 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
414 struct wm831x *wm831x = ldo->wm831x;
415 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
Roel Kluin6f17c652009-12-15 20:07:31 +0100416 int ret;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100417
418 ret = wm831x_reg_read(wm831x, on_reg);
419 if (ret < 0)
420 return 0;
421
422 if (ret & WM831X_LDO7_ON_MODE)
423 return REGULATOR_MODE_IDLE;
424 else
425 return REGULATOR_MODE_NORMAL;
426}
427
428static int wm831x_aldo_set_mode(struct regulator_dev *rdev,
429 unsigned int mode)
430{
431 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
432 struct wm831x *wm831x = ldo->wm831x;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100433 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
434 int ret;
435
436
437 switch (mode) {
438 case REGULATOR_MODE_NORMAL:
Axel Line841a362012-03-29 15:02:55 +0800439 ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE, 0);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100440 if (ret < 0)
441 return ret;
442 break;
443
444 case REGULATOR_MODE_IDLE:
Axel Line841a362012-03-29 15:02:55 +0800445 ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100446 WM831X_LDO7_ON_MODE);
447 if (ret < 0)
448 return ret;
449 break;
450
451 default:
452 return -EINVAL;
453 }
454
455 return 0;
456}
457
458static int wm831x_aldo_get_status(struct regulator_dev *rdev)
459{
460 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
461 struct wm831x *wm831x = ldo->wm831x;
462 int mask = 1 << rdev_get_id(rdev);
463 int ret;
464
465 /* Is the regulator on? */
466 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
467 if (ret < 0)
468 return ret;
469 if (!(ret & mask))
470 return REGULATOR_STATUS_OFF;
471
472 /* Is it reporting under voltage? */
473 ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
Axel Lin363506c2012-07-31 21:28:26 +0800474 if (ret < 0)
475 return ret;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100476 if (ret & mask)
477 return REGULATOR_STATUS_ERROR;
478
479 ret = wm831x_aldo_get_mode(rdev);
480 if (ret < 0)
481 return ret;
482 else
483 return regulator_mode_to_status(ret);
484}
485
486static struct regulator_ops wm831x_aldo_ops = {
487 .list_voltage = wm831x_aldo_list_voltage,
Axel Lin0a479682012-06-12 10:46:43 +0800488 .map_voltage = wm831x_aldo_map_voltage,
Mark Brownac663b42012-04-15 11:55:55 +0100489 .get_voltage_sel = regulator_get_voltage_sel_regmap,
Axel Lin0a479682012-06-12 10:46:43 +0800490 .set_voltage_sel = regulator_set_voltage_sel_regmap,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100491 .set_suspend_voltage = wm831x_aldo_set_suspend_voltage,
492 .get_mode = wm831x_aldo_get_mode,
493 .set_mode = wm831x_aldo_set_mode,
494 .get_status = wm831x_aldo_get_status,
495
Mark Brownca8c3612012-04-15 12:38:52 +0100496 .is_enabled = regulator_is_enabled_regmap,
497 .enable = regulator_enable_regmap,
498 .disable = regulator_disable_regmap,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100499};
500
501static __devinit int wm831x_aldo_probe(struct platform_device *pdev)
502{
503 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
504 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
Mark Brownc1727082012-04-04 00:50:22 +0100505 struct regulator_config config = { };
Mark Brown137a6352011-07-25 22:20:29 +0100506 int id;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100507 struct wm831x_ldo *ldo;
508 struct resource *res;
509 int ret, irq;
510
Mark Brown137a6352011-07-25 22:20:29 +0100511 if (pdata && pdata->wm831x_num)
512 id = (pdata->wm831x_num * 10) + 1;
513 else
514 id = 0;
515 id = pdev->id - id;
516
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100517 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
518
Mark Brownfded2f42011-12-15 02:11:14 +0800519 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100520 if (ldo == NULL) {
521 dev_err(&pdev->dev, "Unable to allocate private data\n");
522 return -ENOMEM;
523 }
524
525 ldo->wm831x = wm831x;
526
527 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
528 if (res == NULL) {
529 dev_err(&pdev->dev, "No I/O resource\n");
530 ret = -EINVAL;
531 goto err;
532 }
533 ldo->base = res->start;
534
535 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
536 ldo->desc.name = ldo->name;
Mark Brownf1aba132012-03-28 21:40:20 +0100537
538 snprintf(ldo->supply_name, sizeof(ldo->supply_name),
539 "LDO%dVDD", id + 1);
540 ldo->desc.supply_name = ldo->supply_name;
541
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100542 ldo->desc.id = id;
543 ldo->desc.type = REGULATOR_VOLTAGE;
544 ldo->desc.n_voltages = WM831X_ALDO_MAX_SELECTOR + 1;
545 ldo->desc.ops = &wm831x_aldo_ops;
546 ldo->desc.owner = THIS_MODULE;
Mark Brownac663b42012-04-15 11:55:55 +0100547 ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
548 ldo->desc.vsel_mask = WM831X_LDO7_ON_VSEL_MASK;
Mark Brownca8c3612012-04-15 12:38:52 +0100549 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
550 ldo->desc.enable_mask = 1 << id;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100551
Mark Brownc1727082012-04-04 00:50:22 +0100552 config.dev = pdev->dev.parent;
Mark Brownb7ca8782012-05-10 00:41:02 +0100553 if (pdata)
554 config.init_data = pdata->ldo[id];
Mark Brownc1727082012-04-04 00:50:22 +0100555 config.driver_data = ldo;
Mark Brownac663b42012-04-15 11:55:55 +0100556 config.regmap = wm831x->regmap;
Mark Brownc1727082012-04-04 00:50:22 +0100557
558 ldo->regulator = regulator_register(&ldo->desc, &config);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100559 if (IS_ERR(ldo->regulator)) {
560 ret = PTR_ERR(ldo->regulator);
561 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
562 id + 1, ret);
563 goto err;
564 }
565
Mark Browncd997582012-05-14 23:14:24 +0200566 irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
Mark Browndfda9c22011-03-01 16:50:43 +0000567 ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
568 IRQF_TRIGGER_RISING, ldo->name, ldo);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100569 if (ret != 0) {
570 dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
571 irq, ret);
572 goto err_regulator;
573 }
574
575 platform_set_drvdata(pdev, ldo);
576
577 return 0;
578
579err_regulator:
580 regulator_unregister(ldo->regulator);
581err:
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100582 return ret;
583}
584
585static __devexit int wm831x_aldo_remove(struct platform_device *pdev)
586{
587 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100588
Mark Browncd997582012-05-14 23:14:24 +0200589 free_irq(wm831x_irq(ldo->wm831x, platform_get_irq_byname(pdev, "UV")),
590 ldo);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100591 regulator_unregister(ldo->regulator);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100592
593 return 0;
594}
595
596static struct platform_driver wm831x_aldo_driver = {
597 .probe = wm831x_aldo_probe,
598 .remove = __devexit_p(wm831x_aldo_remove),
599 .driver = {
600 .name = "wm831x-aldo",
Dmitry Torokhoveb66d562010-02-23 23:38:39 -0800601 .owner = THIS_MODULE,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100602 },
603};
604
605/*
606 * Alive LDO
607 */
608
609#define WM831X_ALIVE_LDO_MAX_SELECTOR 0xf
610
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100611static int wm831x_alive_ldo_set_suspend_voltage(struct regulator_dev *rdev,
612 int uV)
613{
614 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
Axel Lin0a479682012-06-12 10:46:43 +0800615 struct wm831x *wm831x = ldo->wm831x;
616 int sel, reg = ldo->base + WM831X_ALIVE_LDO_SLEEP_CONTROL;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100617
Axel Lin0a479682012-06-12 10:46:43 +0800618 sel = regulator_map_voltage_linear(rdev, uV, uV);
619 if (sel < 0)
620 return sel;
621
622 return wm831x_set_bits(wm831x, reg, WM831X_LDO11_ON_VSEL_MASK, sel);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100623}
624
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100625static int wm831x_alive_ldo_get_status(struct regulator_dev *rdev)
626{
627 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
628 struct wm831x *wm831x = ldo->wm831x;
629 int mask = 1 << rdev_get_id(rdev);
630 int ret;
631
632 /* Is the regulator on? */
633 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
634 if (ret < 0)
635 return ret;
636 if (ret & mask)
637 return REGULATOR_STATUS_ON;
638 else
639 return REGULATOR_STATUS_OFF;
640}
641
642static struct regulator_ops wm831x_alive_ldo_ops = {
Mark Brownd31e9542012-05-09 21:53:32 +0100643 .list_voltage = regulator_list_voltage_linear,
Axel Linc2543b52012-05-31 17:39:00 +0800644 .map_voltage = regulator_map_voltage_linear,
Mark Brownac663b42012-04-15 11:55:55 +0100645 .get_voltage_sel = regulator_get_voltage_sel_regmap,
Axel Lin0a479682012-06-12 10:46:43 +0800646 .set_voltage_sel = regulator_set_voltage_sel_regmap,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100647 .set_suspend_voltage = wm831x_alive_ldo_set_suspend_voltage,
648 .get_status = wm831x_alive_ldo_get_status,
649
Mark Brownca8c3612012-04-15 12:38:52 +0100650 .is_enabled = regulator_is_enabled_regmap,
651 .enable = regulator_enable_regmap,
652 .disable = regulator_disable_regmap,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100653};
654
655static __devinit int wm831x_alive_ldo_probe(struct platform_device *pdev)
656{
657 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
658 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
Mark Brownc1727082012-04-04 00:50:22 +0100659 struct regulator_config config = { };
Mark Brown137a6352011-07-25 22:20:29 +0100660 int id;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100661 struct wm831x_ldo *ldo;
662 struct resource *res;
663 int ret;
664
Mark Brown137a6352011-07-25 22:20:29 +0100665 if (pdata && pdata->wm831x_num)
666 id = (pdata->wm831x_num * 10) + 1;
667 else
668 id = 0;
669 id = pdev->id - id;
670
671
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100672 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
673
Mark Brownfded2f42011-12-15 02:11:14 +0800674 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100675 if (ldo == NULL) {
676 dev_err(&pdev->dev, "Unable to allocate private data\n");
677 return -ENOMEM;
678 }
679
680 ldo->wm831x = wm831x;
681
682 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
683 if (res == NULL) {
684 dev_err(&pdev->dev, "No I/O resource\n");
685 ret = -EINVAL;
686 goto err;
687 }
688 ldo->base = res->start;
689
690 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
691 ldo->desc.name = ldo->name;
Mark Brownf1aba132012-03-28 21:40:20 +0100692
693 snprintf(ldo->supply_name, sizeof(ldo->supply_name),
694 "LDO%dVDD", id + 1);
695 ldo->desc.supply_name = ldo->supply_name;
696
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100697 ldo->desc.id = id;
698 ldo->desc.type = REGULATOR_VOLTAGE;
699 ldo->desc.n_voltages = WM831X_ALIVE_LDO_MAX_SELECTOR + 1;
700 ldo->desc.ops = &wm831x_alive_ldo_ops;
701 ldo->desc.owner = THIS_MODULE;
Mark Brownac663b42012-04-15 11:55:55 +0100702 ldo->desc.vsel_reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
703 ldo->desc.vsel_mask = WM831X_LDO11_ON_VSEL_MASK;
Mark Brownca8c3612012-04-15 12:38:52 +0100704 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
705 ldo->desc.enable_mask = 1 << id;
Mark Brownd31e9542012-05-09 21:53:32 +0100706 ldo->desc.min_uV = 800000;
707 ldo->desc.uV_step = 50000;
Mark Browneefaa3c2012-06-27 15:00:02 +0100708 ldo->desc.enable_time = 1000;
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100709
Mark Brownc1727082012-04-04 00:50:22 +0100710 config.dev = pdev->dev.parent;
Mark Brownb7ca8782012-05-10 00:41:02 +0100711 if (pdata)
712 config.init_data = pdata->ldo[id];
Mark Brownc1727082012-04-04 00:50:22 +0100713 config.driver_data = ldo;
Mark Brownac663b42012-04-15 11:55:55 +0100714 config.regmap = wm831x->regmap;
Mark Brownc1727082012-04-04 00:50:22 +0100715
716 ldo->regulator = regulator_register(&ldo->desc, &config);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100717 if (IS_ERR(ldo->regulator)) {
718 ret = PTR_ERR(ldo->regulator);
719 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
720 id + 1, ret);
721 goto err;
722 }
723
724 platform_set_drvdata(pdev, ldo);
725
726 return 0;
727
728err:
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100729 return ret;
730}
731
732static __devexit int wm831x_alive_ldo_remove(struct platform_device *pdev)
733{
734 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
735
736 regulator_unregister(ldo->regulator);
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100737
738 return 0;
739}
740
741static struct platform_driver wm831x_alive_ldo_driver = {
742 .probe = wm831x_alive_ldo_probe,
743 .remove = __devexit_p(wm831x_alive_ldo_remove),
744 .driver = {
745 .name = "wm831x-alive-ldo",
Dmitry Torokhoveb66d562010-02-23 23:38:39 -0800746 .owner = THIS_MODULE,
Mark Brownd1c6b4f2009-07-28 15:22:02 +0100747 },
748};
749
750static int __init wm831x_ldo_init(void)
751{
752 int ret;
753
754 ret = platform_driver_register(&wm831x_gp_ldo_driver);
755 if (ret != 0)
756 pr_err("Failed to register WM831x GP LDO driver: %d\n", ret);
757
758 ret = platform_driver_register(&wm831x_aldo_driver);
759 if (ret != 0)
760 pr_err("Failed to register WM831x ALDO driver: %d\n", ret);
761
762 ret = platform_driver_register(&wm831x_alive_ldo_driver);
763 if (ret != 0)
764 pr_err("Failed to register WM831x alive LDO driver: %d\n",
765 ret);
766
767 return 0;
768}
769subsys_initcall(wm831x_ldo_init);
770
771static void __exit wm831x_ldo_exit(void)
772{
773 platform_driver_unregister(&wm831x_alive_ldo_driver);
774 platform_driver_unregister(&wm831x_aldo_driver);
775 platform_driver_unregister(&wm831x_gp_ldo_driver);
776}
777module_exit(wm831x_ldo_exit);
778
779/* Module information */
780MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
781MODULE_DESCRIPTION("WM831x LDO driver");
782MODULE_LICENSE("GPL");
783MODULE_ALIAS("platform:wm831x-ldo");
784MODULE_ALIAS("platform:wm831x-aldo");
785MODULE_ALIAS("platform:wm831x-aliveldo");