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