]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/regulator/wm831x-ldo.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
regulator: 88pm8607: Use regulator_get_voltage_sel_regmap()
[mirror_ubuntu-bionic-kernel.git] / drivers / regulator / wm831x-ldo.c
CommitLineData
d1c6b4fe
MB		 1/*
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>
5a0e3ad6 22#include <linux/slab.h>
d1c6b4fe
MB		 23
24#include <linux/mfd/wm831x/core.h>
25#include <linux/mfd/wm831x/regulator.h>
26#include <linux/mfd/wm831x/pdata.h>
27
28#define WM831X_LDO_MAX_NAME 6
29
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];
39 struct regulator_desc desc;
40 int base;
41 struct wm831x *wm831x;
42 struct regulator_dev *regulator;
43};
44
45/*
46 * Shared
47 */
48
d1c6b4fe
MB		 49static irqreturn_t wm831x_ldo_uv_irq(int irq, void *data)
50{
51 struct wm831x_ldo *ldo = data;
52
53 regulator_notifier_call_chain(ldo->regulator,
54 REGULATOR_EVENT_UNDER_VOLTAGE,
55 NULL);
56
57 return IRQ_HANDLED;
58}
59
60/*
61 * General purpose LDOs
62 */
63
64#define WM831X_GP_LDO_SELECTOR_LOW 0xe
65#define WM831X_GP_LDO_MAX_SELECTOR 0x1f
66
67static int wm831x_gp_ldo_list_voltage(struct regulator_dev *rdev,
68 unsigned int selector)
69{
70 /* 0.9-1.6V in 50mV steps */
71 if (selector <= WM831X_GP_LDO_SELECTOR_LOW)
72 return 900000 + (selector * 50000);
6085d4d9 73 /* 1.7-3.3V in 100mV steps */
d1c6b4fe
MB		 74 if (selector <= WM831X_GP_LDO_MAX_SELECTOR)
75 return 1600000 + ((selector - WM831X_GP_LDO_SELECTOR_LOW)
76 * 100000);
77 return -EINVAL;
78}
79
80static int wm831x_gp_ldo_set_voltage_int(struct regulator_dev *rdev, int reg,
3a93f2a9
MB		 81 int min_uV, int max_uV,
82 unsigned *selector)
d1c6b4fe
MB		 83{
84 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
85 struct wm831x *wm831x = ldo->wm831x;
86 int vsel, ret;
87
88 if (min_uV < 900000)
89 vsel = 0;
90 else if (min_uV < 1700000)
91 vsel = ((min_uV - 900000) / 50000);
92 else
93 vsel = ((min_uV - 1700000) / 100000)
94 + WM831X_GP_LDO_SELECTOR_LOW + 1;
95
96 ret = wm831x_gp_ldo_list_voltage(rdev, vsel);
97 if (ret < 0)
98 return ret;
99 if (ret < min_uV || ret > max_uV)
100 return -EINVAL;
101
3a93f2a9
MB		 102 *selector = vsel;
103
d1c6b4fe
MB		 104 return wm831x_set_bits(wm831x, reg, WM831X_LDO1_ON_VSEL_MASK, vsel);
105}
106
107static int wm831x_gp_ldo_set_voltage(struct regulator_dev *rdev,
3a93f2a9
MB		 108 int min_uV, int max_uV,
109 unsigned *selector)
d1c6b4fe
MB		 110{
111 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
112 int reg = ldo->base + WM831X_LDO_ON_CONTROL;
113
3a93f2a9
MB		 114 return wm831x_gp_ldo_set_voltage_int(rdev, reg, min_uV, max_uV,
115 selector);
d1c6b4fe
MB		 116}
117
118static int wm831x_gp_ldo_set_suspend_voltage(struct regulator_dev *rdev,
119 int uV)
120{
121 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
122 int reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
3a93f2a9 123 unsigned int selector;
d1c6b4fe 124
3a93f2a9 125 return wm831x_gp_ldo_set_voltage_int(rdev, reg, uV, uV, &selector);
d1c6b4fe
MB		 126}
127
d1c6b4fe
MB		 128static unsigned int wm831x_gp_ldo_get_mode(struct regulator_dev *rdev)
129{
130 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
131 struct wm831x *wm831x = ldo->wm831x;
132 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
133 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
9a767d43 134 int ret;
d1c6b4fe
MB		 135
136 ret = wm831x_reg_read(wm831x, on_reg);
137 if (ret < 0)
9a767d43 138 return ret;
d1c6b4fe
MB		 139
140 if (!(ret & WM831X_LDO1_ON_MODE))
141 return REGULATOR_MODE_NORMAL;
142
143 ret = wm831x_reg_read(wm831x, ctrl_reg);
144 if (ret < 0)
9a767d43 145 return ret;
d1c6b4fe
MB		 146
147 if (ret & WM831X_LDO1_LP_MODE)
148 return REGULATOR_MODE_STANDBY;
149 else
150 return REGULATOR_MODE_IDLE;
151}
152
153static int wm831x_gp_ldo_set_mode(struct regulator_dev *rdev,
154 unsigned int mode)
155{
156 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
157 struct wm831x *wm831x = ldo->wm831x;
158 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
159 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
160 int ret;
161
162
163 switch (mode) {
164 case REGULATOR_MODE_NORMAL:
165 ret = wm831x_set_bits(wm831x, on_reg,
166 WM831X_LDO1_ON_MODE, 0);
167 if (ret < 0)
168 return ret;
169 break;
170
171 case REGULATOR_MODE_IDLE:
172 ret = wm831x_set_bits(wm831x, ctrl_reg,
e260999c 173 WM831X_LDO1_LP_MODE, 0);
d1c6b4fe
MB		 174 if (ret < 0)
175 return ret;
176
177 ret = wm831x_set_bits(wm831x, on_reg,
178 WM831X_LDO1_ON_MODE,
179 WM831X_LDO1_ON_MODE);
180 if (ret < 0)
181 return ret;
e260999c 182 break;
d1c6b4fe
MB		 183
184 case REGULATOR_MODE_STANDBY:
185 ret = wm831x_set_bits(wm831x, ctrl_reg,
e260999c
AL		 186 WM831X_LDO1_LP_MODE,
187 WM831X_LDO1_LP_MODE);
d1c6b4fe
MB		 188 if (ret < 0)
189 return ret;
190
191 ret = wm831x_set_bits(wm831x, on_reg,
192 WM831X_LDO1_ON_MODE,
193 WM831X_LDO1_ON_MODE);
194 if (ret < 0)
195 return ret;
196 break;
197
198 default:
199 return -EINVAL;
200 }
201
202 return 0;
203}
204
205static int wm831x_gp_ldo_get_status(struct regulator_dev *rdev)
206{
207 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
208 struct wm831x *wm831x = ldo->wm831x;
209 int mask = 1 << rdev_get_id(rdev);
210 int ret;
211
212 /* Is the regulator on? */
213 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
214 if (ret < 0)
215 return ret;
216 if (!(ret & mask))
217 return REGULATOR_STATUS_OFF;
218
219 /* Is it reporting under voltage? */
220 ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
221 if (ret & mask)
222 return REGULATOR_STATUS_ERROR;
223
224 ret = wm831x_gp_ldo_get_mode(rdev);
225 if (ret < 0)
226 return ret;
227 else
228 return regulator_mode_to_status(ret);
229}
230
231static unsigned int wm831x_gp_ldo_get_optimum_mode(struct regulator_dev *rdev,
232 int input_uV,
233 int output_uV, int load_uA)
234{
235 if (load_uA < 20000)
236 return REGULATOR_MODE_STANDBY;
237 if (load_uA < 50000)
238 return REGULATOR_MODE_IDLE;
239 return REGULATOR_MODE_NORMAL;
240}
241
242
243static struct regulator_ops wm831x_gp_ldo_ops = {
244 .list_voltage = wm831x_gp_ldo_list_voltage,
ac663b47 245 .get_voltage_sel = regulator_get_voltage_sel_regmap,
d1c6b4fe
MB		 246 .set_voltage = wm831x_gp_ldo_set_voltage,
247 .set_suspend_voltage = wm831x_gp_ldo_set_suspend_voltage,
248 .get_mode = wm831x_gp_ldo_get_mode,
249 .set_mode = wm831x_gp_ldo_set_mode,
250 .get_status = wm831x_gp_ldo_get_status,
251 .get_optimum_mode = wm831x_gp_ldo_get_optimum_mode,
252
ca8c361b
MB		 253 .is_enabled = regulator_is_enabled_regmap,
254 .enable = regulator_enable_regmap,
255 .disable = regulator_disable_regmap,
d1c6b4fe
MB		 256};
257
258static __devinit int wm831x_gp_ldo_probe(struct platform_device *pdev)
259{
260 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
261 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
c172708d 262 struct regulator_config config = { };
137a6354 263 int id;
d1c6b4fe
MB		 264 struct wm831x_ldo *ldo;
265 struct resource *res;
266 int ret, irq;
267
137a6354
MB		 268 if (pdata && pdata->wm831x_num)
269 id = (pdata->wm831x_num * 10) + 1;
270 else
271 id = 0;
272 id = pdev->id - id;
273
d1c6b4fe
MB		 274 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
275
276 if (pdata == NULL || pdata->ldo[id] == NULL)
277 return -ENODEV;
278
fded2f4f 279 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
d1c6b4fe
MB		 280 if (ldo == NULL) {
281 dev_err(&pdev->dev, "Unable to allocate private data\n");
282 return -ENOMEM;
283 }
284
285 ldo->wm831x = wm831x;
286
287 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
288 if (res == NULL) {
289 dev_err(&pdev->dev, "No I/O resource\n");
290 ret = -EINVAL;
291 goto err;
292 }
293 ldo->base = res->start;
294
295 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
296 ldo->desc.name = ldo->name;
297 ldo->desc.id = id;
298 ldo->desc.type = REGULATOR_VOLTAGE;
299 ldo->desc.n_voltages = WM831X_GP_LDO_MAX_SELECTOR + 1;
300 ldo->desc.ops = &wm831x_gp_ldo_ops;
301 ldo->desc.owner = THIS_MODULE;
ac663b47
MB		 302 ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
303 ldo->desc.vsel_mask = WM831X_LDO1_ON_VSEL_MASK;
ca8c361b
MB		 304 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
305 ldo->desc.enable_mask = 1 << id;
d1c6b4fe 306
c172708d
MB		 307 config.dev = pdev->dev.parent;
308 config.init_data = pdata->ldo[id];
309 config.driver_data = ldo;
ac663b47 310 config.regmap = wm831x->regmap;
c172708d
MB		 311
312 ldo->regulator = regulator_register(&ldo->desc, &config);
d1c6b4fe
MB		 313 if (IS_ERR(ldo->regulator)) {
314 ret = PTR_ERR(ldo->regulator);
315 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
316 id + 1, ret);
317 goto err;
318 }
319
320 irq = platform_get_irq_byname(pdev, "UV");
dfda9c27
MB		 321 ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
322 IRQF_TRIGGER_RISING, ldo->name,
323 ldo);
d1c6b4fe
MB		 324 if (ret != 0) {
325 dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
326 irq, ret);
327 goto err_regulator;
328 }
329
330 platform_set_drvdata(pdev, ldo);
331
332 return 0;
333
334err_regulator:
335 regulator_unregister(ldo->regulator);
336err:
d1c6b4fe
MB		 337 return ret;
338}
339
340static __devexit int wm831x_gp_ldo_remove(struct platform_device *pdev)
341{
342 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
d1c6b4fe 343
eb66d565
DT		 344 platform_set_drvdata(pdev, NULL);
345
dfda9c27 346 free_irq(platform_get_irq_byname(pdev, "UV"), ldo);
d1c6b4fe 347 regulator_unregister(ldo->regulator);
d1c6b4fe
MB		 348
349 return 0;
350}
351
352static struct platform_driver wm831x_gp_ldo_driver = {
353 .probe = wm831x_gp_ldo_probe,
354 .remove = __devexit_p(wm831x_gp_ldo_remove),
355 .driver = {
356 .name = "wm831x-ldo",
eb66d565 357 .owner = THIS_MODULE,
d1c6b4fe
MB		 358 },
359};
360
361/*
362 * Analogue LDOs
363 */
364
365
366#define WM831X_ALDO_SELECTOR_LOW 0xc
367#define WM831X_ALDO_MAX_SELECTOR 0x1f
368
369static int wm831x_aldo_list_voltage(struct regulator_dev *rdev,
370 unsigned int selector)
371{
372 /* 1-1.6V in 50mV steps */
373 if (selector <= WM831X_ALDO_SELECTOR_LOW)
374 return 1000000 + (selector * 50000);
6085d4d9 375 /* 1.7-3.5V in 100mV steps */
d1c6b4fe
MB		 376 if (selector <= WM831X_ALDO_MAX_SELECTOR)
377 return 1600000 + ((selector - WM831X_ALDO_SELECTOR_LOW)
378 * 100000);
379 return -EINVAL;
380}
381
382static int wm831x_aldo_set_voltage_int(struct regulator_dev *rdev, int reg,
3a93f2a9
MB		 383 int min_uV, int max_uV,
384 unsigned *selector)
d1c6b4fe
MB		 385{
386 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
387 struct wm831x *wm831x = ldo->wm831x;
388 int vsel, ret;
389
390 if (min_uV < 1000000)
391 vsel = 0;
392 else if (min_uV < 1700000)
393 vsel = ((min_uV - 1000000) / 50000);
394 else
395 vsel = ((min_uV - 1700000) / 100000)
396 + WM831X_ALDO_SELECTOR_LOW + 1;
397
398 ret = wm831x_aldo_list_voltage(rdev, vsel);
399 if (ret < 0)
400 return ret;
401 if (ret < min_uV || ret > max_uV)
402 return -EINVAL;
403
3a93f2a9
MB		 404 *selector = vsel;
405
d1c6b4fe
MB		 406 return wm831x_set_bits(wm831x, reg, WM831X_LDO7_ON_VSEL_MASK, vsel);
407}
408
409static int wm831x_aldo_set_voltage(struct regulator_dev *rdev,
3a93f2a9 410 int min_uV, int max_uV, unsigned *selector)
d1c6b4fe
MB		 411{
412 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
413 int reg = ldo->base + WM831X_LDO_ON_CONTROL;
414
3a93f2a9
MB		 415 return wm831x_aldo_set_voltage_int(rdev, reg, min_uV, max_uV,
416 selector);
d1c6b4fe
MB		 417}
418
419static int wm831x_aldo_set_suspend_voltage(struct regulator_dev *rdev,
420 int uV)
421{
422 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
423 int reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
3a93f2a9 424 unsigned int selector;
d1c6b4fe 425
3a93f2a9 426 return wm831x_aldo_set_voltage_int(rdev, reg, uV, uV, &selector);
d1c6b4fe
MB		 427}
428
d1c6b4fe
MB		 429static unsigned int wm831x_aldo_get_mode(struct regulator_dev *rdev)
430{
431 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
432 struct wm831x *wm831x = ldo->wm831x;
433 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
6f17c652 434 int ret;
d1c6b4fe
MB		 435
436 ret = wm831x_reg_read(wm831x, on_reg);
437 if (ret < 0)
438 return 0;
439
440 if (ret & WM831X_LDO7_ON_MODE)
441 return REGULATOR_MODE_IDLE;
442 else
443 return REGULATOR_MODE_NORMAL;
444}
445
446static int wm831x_aldo_set_mode(struct regulator_dev *rdev,
447 unsigned int mode)
448{
449 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
450 struct wm831x *wm831x = ldo->wm831x;
d1c6b4fe
MB		 451 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
452 int ret;
453
454
455 switch (mode) {
456 case REGULATOR_MODE_NORMAL:
e841a36a 457 ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE, 0);
d1c6b4fe
MB		 458 if (ret < 0)
459 return ret;
460 break;
461
462 case REGULATOR_MODE_IDLE:
e841a36a 463 ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE,
d1c6b4fe
MB		 464 WM831X_LDO7_ON_MODE);
465 if (ret < 0)
466 return ret;
467 break;
468
469 default:
470 return -EINVAL;
471 }
472
473 return 0;
474}
475
476static int wm831x_aldo_get_status(struct regulator_dev *rdev)
477{
478 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
479 struct wm831x *wm831x = ldo->wm831x;
480 int mask = 1 << rdev_get_id(rdev);
481 int ret;
482
483 /* Is the regulator on? */
484 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
485 if (ret < 0)
486 return ret;
487 if (!(ret & mask))
488 return REGULATOR_STATUS_OFF;
489
490 /* Is it reporting under voltage? */
491 ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
492 if (ret & mask)
493 return REGULATOR_STATUS_ERROR;
494
495 ret = wm831x_aldo_get_mode(rdev);
496 if (ret < 0)
497 return ret;
498 else
499 return regulator_mode_to_status(ret);
500}
501
502static struct regulator_ops wm831x_aldo_ops = {
503 .list_voltage = wm831x_aldo_list_voltage,
ac663b47 504 .get_voltage_sel = regulator_get_voltage_sel_regmap,
d1c6b4fe
MB		 505 .set_voltage = wm831x_aldo_set_voltage,
506 .set_suspend_voltage = wm831x_aldo_set_suspend_voltage,
507 .get_mode = wm831x_aldo_get_mode,
508 .set_mode = wm831x_aldo_set_mode,
509 .get_status = wm831x_aldo_get_status,
510
ca8c361b
MB		 511 .is_enabled = regulator_is_enabled_regmap,
512 .enable = regulator_enable_regmap,
513 .disable = regulator_disable_regmap,
d1c6b4fe
MB		 514};
515
516static __devinit int wm831x_aldo_probe(struct platform_device *pdev)
517{
518 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
519 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
c172708d 520 struct regulator_config config = { };
137a6354 521 int id;
d1c6b4fe
MB		 522 struct wm831x_ldo *ldo;
523 struct resource *res;
524 int ret, irq;
525
137a6354
MB		 526 if (pdata && pdata->wm831x_num)
527 id = (pdata->wm831x_num * 10) + 1;
528 else
529 id = 0;
530 id = pdev->id - id;
531
d1c6b4fe
MB		 532 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
533
534 if (pdata == NULL || pdata->ldo[id] == NULL)
535 return -ENODEV;
536
fded2f4f 537 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
d1c6b4fe
MB		 538 if (ldo == NULL) {
539 dev_err(&pdev->dev, "Unable to allocate private data\n");
540 return -ENOMEM;
541 }
542
543 ldo->wm831x = wm831x;
544
545 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
546 if (res == NULL) {
547 dev_err(&pdev->dev, "No I/O resource\n");
548 ret = -EINVAL;
549 goto err;
550 }
551 ldo->base = res->start;
552
553 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
554 ldo->desc.name = ldo->name;
555 ldo->desc.id = id;
556 ldo->desc.type = REGULATOR_VOLTAGE;
557 ldo->desc.n_voltages = WM831X_ALDO_MAX_SELECTOR + 1;
558 ldo->desc.ops = &wm831x_aldo_ops;
559 ldo->desc.owner = THIS_MODULE;
ac663b47
MB		 560 ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
561 ldo->desc.vsel_mask = WM831X_LDO7_ON_VSEL_MASK;
ca8c361b
MB		 562 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
563 ldo->desc.enable_mask = 1 << id;
d1c6b4fe 564
c172708d
MB		 565 config.dev = pdev->dev.parent;
566 config.init_data = pdata->ldo[id];
567 config.driver_data = ldo;
ac663b47 568 config.regmap = wm831x->regmap;
c172708d
MB		 569
570 ldo->regulator = regulator_register(&ldo->desc, &config);
d1c6b4fe
MB		 571 if (IS_ERR(ldo->regulator)) {
572 ret = PTR_ERR(ldo->regulator);
573 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
574 id + 1, ret);
575 goto err;
576 }
577
578 irq = platform_get_irq_byname(pdev, "UV");
dfda9c27
MB		 579 ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
580 IRQF_TRIGGER_RISING, ldo->name, ldo);
d1c6b4fe
MB		 581 if (ret != 0) {
582 dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
583 irq, ret);
584 goto err_regulator;
585 }
586
587 platform_set_drvdata(pdev, ldo);
588
589 return 0;
590
591err_regulator:
592 regulator_unregister(ldo->regulator);
593err:
d1c6b4fe
MB		 594 return ret;
595}
596
597static __devexit int wm831x_aldo_remove(struct platform_device *pdev)
598{
599 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
d1c6b4fe 600
dfda9c27 601 free_irq(platform_get_irq_byname(pdev, "UV"), ldo);
d1c6b4fe 602 regulator_unregister(ldo->regulator);
d1c6b4fe
MB		 603
604 return 0;
605}
606
607static struct platform_driver wm831x_aldo_driver = {
608 .probe = wm831x_aldo_probe,
609 .remove = __devexit_p(wm831x_aldo_remove),
610 .driver = {
611 .name = "wm831x-aldo",
eb66d565 612 .owner = THIS_MODULE,
d1c6b4fe
MB		 613 },
614};
615
616/*
617 * Alive LDO
618 */
619
620#define WM831X_ALIVE_LDO_MAX_SELECTOR 0xf
621
622static int wm831x_alive_ldo_list_voltage(struct regulator_dev *rdev,
623 unsigned int selector)
624{
625 /* 0.8-1.55V in 50mV steps */
626 if (selector <= WM831X_ALIVE_LDO_MAX_SELECTOR)
627 return 800000 + (selector * 50000);
628 return -EINVAL;
629}
630
631static int wm831x_alive_ldo_set_voltage_int(struct regulator_dev *rdev,
632 int reg,
3a93f2a9
MB		 633 int min_uV, int max_uV,
634 unsigned *selector)
d1c6b4fe
MB		 635{
636 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
637 struct wm831x *wm831x = ldo->wm831x;
638 int vsel, ret;
639
640 vsel = (min_uV - 800000) / 50000;
641
642 ret = wm831x_alive_ldo_list_voltage(rdev, vsel);
643 if (ret < 0)
644 return ret;
645 if (ret < min_uV || ret > max_uV)
646 return -EINVAL;
647
3a93f2a9
MB		 648 *selector = vsel;
649
d1c6b4fe
MB		 650 return wm831x_set_bits(wm831x, reg, WM831X_LDO11_ON_VSEL_MASK, vsel);
651}
652
653static int wm831x_alive_ldo_set_voltage(struct regulator_dev *rdev,
3a93f2a9
MB		 654 int min_uV, int max_uV,
655 unsigned *selector)
d1c6b4fe
MB		 656{
657 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
658 int reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
659
3a93f2a9
MB		 660 return wm831x_alive_ldo_set_voltage_int(rdev, reg, min_uV, max_uV,
661 selector);
d1c6b4fe
MB		 662}
663
664static int wm831x_alive_ldo_set_suspend_voltage(struct regulator_dev *rdev,
665 int uV)
666{
667 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
668 int reg = ldo->base + WM831X_ALIVE_LDO_SLEEP_CONTROL;
3a93f2a9 669 unsigned selector;
d1c6b4fe 670
3a93f2a9 671 return wm831x_alive_ldo_set_voltage_int(rdev, reg, uV, uV, &selector);
d1c6b4fe
MB		 672}
673
d1c6b4fe
MB		 674static int wm831x_alive_ldo_get_status(struct regulator_dev *rdev)
675{
676 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
677 struct wm831x *wm831x = ldo->wm831x;
678 int mask = 1 << rdev_get_id(rdev);
679 int ret;
680
681 /* Is the regulator on? */
682 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
683 if (ret < 0)
684 return ret;
685 if (ret & mask)
686 return REGULATOR_STATUS_ON;
687 else
688 return REGULATOR_STATUS_OFF;
689}
690
691static struct regulator_ops wm831x_alive_ldo_ops = {
692 .list_voltage = wm831x_alive_ldo_list_voltage,
ac663b47 693 .get_voltage_sel = regulator_get_voltage_sel_regmap,
d1c6b4fe
MB		 694 .set_voltage = wm831x_alive_ldo_set_voltage,
695 .set_suspend_voltage = wm831x_alive_ldo_set_suspend_voltage,
696 .get_status = wm831x_alive_ldo_get_status,
697
ca8c361b
MB		 698 .is_enabled = regulator_is_enabled_regmap,
699 .enable = regulator_enable_regmap,
700 .disable = regulator_disable_regmap,
d1c6b4fe
MB		 701};
702
703static __devinit int wm831x_alive_ldo_probe(struct platform_device *pdev)
704{
705 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
706 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
c172708d 707 struct regulator_config config = { };
137a6354 708 int id;
d1c6b4fe
MB		 709 struct wm831x_ldo *ldo;
710 struct resource *res;
711 int ret;
712
137a6354
MB		 713 if (pdata && pdata->wm831x_num)
714 id = (pdata->wm831x_num * 10) + 1;
715 else
716 id = 0;
717 id = pdev->id - id;
718
719
d1c6b4fe
MB		 720 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
721
722 if (pdata == NULL || pdata->ldo[id] == NULL)
723 return -ENODEV;
724
fded2f4f 725 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
d1c6b4fe
MB		 726 if (ldo == NULL) {
727 dev_err(&pdev->dev, "Unable to allocate private data\n");
728 return -ENOMEM;
729 }
730
731 ldo->wm831x = wm831x;
732
733 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
734 if (res == NULL) {
735 dev_err(&pdev->dev, "No I/O resource\n");
736 ret = -EINVAL;
737 goto err;
738 }
739 ldo->base = res->start;
740
741 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
742 ldo->desc.name = ldo->name;
743 ldo->desc.id = id;
744 ldo->desc.type = REGULATOR_VOLTAGE;
745 ldo->desc.n_voltages = WM831X_ALIVE_LDO_MAX_SELECTOR + 1;
746 ldo->desc.ops = &wm831x_alive_ldo_ops;
747 ldo->desc.owner = THIS_MODULE;
ac663b47
MB		 748 ldo->desc.vsel_reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
749 ldo->desc.vsel_mask = WM831X_LDO11_ON_VSEL_MASK;
ca8c361b
MB		 750 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
751 ldo->desc.enable_mask = 1 << id;
d1c6b4fe 752
c172708d
MB		 753 config.dev = pdev->dev.parent;
754 config.init_data = pdata->ldo[id];
755 config.driver_data = ldo;
ac663b47 756 config.regmap = wm831x->regmap;
c172708d
MB		 757
758 ldo->regulator = regulator_register(&ldo->desc, &config);
d1c6b4fe
MB		 759 if (IS_ERR(ldo->regulator)) {
760 ret = PTR_ERR(ldo->regulator);
761 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
762 id + 1, ret);
763 goto err;
764 }
765
766 platform_set_drvdata(pdev, ldo);
767
768 return 0;
769
770err:
d1c6b4fe
MB		 771 return ret;
772}
773
774static __devexit int wm831x_alive_ldo_remove(struct platform_device *pdev)
775{
776 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
777
778 regulator_unregister(ldo->regulator);
d1c6b4fe
MB		 779
780 return 0;
781}
782
783static struct platform_driver wm831x_alive_ldo_driver = {
784 .probe = wm831x_alive_ldo_probe,
785 .remove = __devexit_p(wm831x_alive_ldo_remove),
786 .driver = {
787 .name = "wm831x-alive-ldo",
eb66d565 788 .owner = THIS_MODULE,
d1c6b4fe
MB		 789 },
790};
791
792static int __init wm831x_ldo_init(void)
793{
794 int ret;
795
796 ret = platform_driver_register(&wm831x_gp_ldo_driver);
797 if (ret != 0)
798 pr_err("Failed to register WM831x GP LDO driver: %d\n", ret);
799
800 ret = platform_driver_register(&wm831x_aldo_driver);
801 if (ret != 0)
802 pr_err("Failed to register WM831x ALDO driver: %d\n", ret);
803
804 ret = platform_driver_register(&wm831x_alive_ldo_driver);
805 if (ret != 0)
806 pr_err("Failed to register WM831x alive LDO driver: %d\n",
807 ret);
808
809 return 0;
810}
811subsys_initcall(wm831x_ldo_init);
812
813static void __exit wm831x_ldo_exit(void)
814{
815 platform_driver_unregister(&wm831x_alive_ldo_driver);
816 platform_driver_unregister(&wm831x_aldo_driver);
817 platform_driver_unregister(&wm831x_gp_ldo_driver);
818}
819module_exit(wm831x_ldo_exit);
820
821/* Module information */
822MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
823MODULE_DESCRIPTION("WM831x LDO driver");
824MODULE_LICENSE("GPL");
825MODULE_ALIAS("platform:wm831x-ldo");
826MODULE_ALIAS("platform:wm831x-aldo");
827MODULE_ALIAS("platform:wm831x-aliveldo");
ubuntu-bionic-kernel mirror