projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
regulator: wm831x-isink: Use devm_request_threaded_irq()
[deliverable/linux.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
f1aba13f 28#define WM831X_LDO_MAX_NAME 9
d1c6b4fe
MB		 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];
f1aba13f 39 char supply_name[WM831X_LDO_MAX_NAME];
d1c6b4fe
MB		 40 struct regulator_desc desc;
41 int base;
42 struct wm831x *wm831x;
43 struct regulator_dev *regulator;
44};
45
46/*
47 * Shared
48 */
49
d1c6b4fe
MB		 50static 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
5ff26a14
MB		 65static const struct regulator_linear_range wm831x_gp_ldo_ranges[] = {
66 { .min_uV = 900000, .max_uV = 1650000, .min_sel = 0, .max_sel = 14,
67 .uV_step = 50000 },
68 { .min_uV = 1700000, .max_uV = 3300000, .min_sel = 15, .max_sel = 31,
69 .uV_step = 100000 },
70};
d1c6b4fe
MB		 71
72static int wm831x_gp_ldo_set_suspend_voltage(struct regulator_dev *rdev,
73 int uV)
74{
75 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
0a479689
AL		 76 struct wm831x *wm831x = ldo->wm831x;
77 int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
d1c6b4fe 78
5ff26a14 79 sel = regulator_map_voltage_linear_range(rdev, uV, uV);
0a479689
AL		 80 if (sel < 0)
81 return sel;
82
83 return wm831x_set_bits(wm831x, reg, WM831X_LDO1_ON_VSEL_MASK, sel);
d1c6b4fe
MB		 84}
85
d1c6b4fe
MB		 86static unsigned int wm831x_gp_ldo_get_mode(struct regulator_dev *rdev)
87{
88 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
89 struct wm831x *wm831x = ldo->wm831x;
90 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
91 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
9a767d43 92 int ret;
d1c6b4fe
MB		 93
94 ret = wm831x_reg_read(wm831x, on_reg);
95 if (ret < 0)
9a767d43 96 return ret;
d1c6b4fe
MB		 97
98 if (!(ret & WM831X_LDO1_ON_MODE))
99 return REGULATOR_MODE_NORMAL;
100
101 ret = wm831x_reg_read(wm831x, ctrl_reg);
102 if (ret < 0)
9a767d43 103 return ret;
d1c6b4fe
MB		 104
105 if (ret & WM831X_LDO1_LP_MODE)
106 return REGULATOR_MODE_STANDBY;
107 else
108 return REGULATOR_MODE_IDLE;
109}
110
111static int wm831x_gp_ldo_set_mode(struct regulator_dev *rdev,
112 unsigned int mode)
113{
114 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
115 struct wm831x *wm831x = ldo->wm831x;
116 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
117 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
118 int ret;
119
120
121 switch (mode) {
122 case REGULATOR_MODE_NORMAL:
123 ret = wm831x_set_bits(wm831x, on_reg,
124 WM831X_LDO1_ON_MODE, 0);
125 if (ret < 0)
126 return ret;
127 break;
128
129 case REGULATOR_MODE_IDLE:
130 ret = wm831x_set_bits(wm831x, ctrl_reg,
e260999c 131 WM831X_LDO1_LP_MODE, 0);
d1c6b4fe
MB		 132 if (ret < 0)
133 return ret;
134
135 ret = wm831x_set_bits(wm831x, on_reg,
136 WM831X_LDO1_ON_MODE,
137 WM831X_LDO1_ON_MODE);
138 if (ret < 0)
139 return ret;
e260999c 140 break;
d1c6b4fe
MB		 141
142 case REGULATOR_MODE_STANDBY:
143 ret = wm831x_set_bits(wm831x, ctrl_reg,
e260999c
AL		 144 WM831X_LDO1_LP_MODE,
145 WM831X_LDO1_LP_MODE);
d1c6b4fe
MB		 146 if (ret < 0)
147 return ret;
148
149 ret = wm831x_set_bits(wm831x, on_reg,
150 WM831X_LDO1_ON_MODE,
151 WM831X_LDO1_ON_MODE);
152 if (ret < 0)
153 return ret;
154 break;
155
156 default:
157 return -EINVAL;
158 }
159
160 return 0;
161}
162
163static int wm831x_gp_ldo_get_status(struct regulator_dev *rdev)
164{
165 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
166 struct wm831x *wm831x = ldo->wm831x;
167 int mask = 1 << rdev_get_id(rdev);
168 int ret;
169
170 /* Is the regulator on? */
171 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
172 if (ret < 0)
173 return ret;
174 if (!(ret & mask))
175 return REGULATOR_STATUS_OFF;
176
177 /* Is it reporting under voltage? */
178 ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
363506cd
AL		 179 if (ret < 0)
180 return ret;
d1c6b4fe
MB		 181 if (ret & mask)
182 return REGULATOR_STATUS_ERROR;
183
184 ret = wm831x_gp_ldo_get_mode(rdev);
185 if (ret < 0)
186 return ret;
187 else
188 return regulator_mode_to_status(ret);
189}
190
191static unsigned int wm831x_gp_ldo_get_optimum_mode(struct regulator_dev *rdev,
192 int input_uV,
193 int output_uV, int load_uA)
194{
195 if (load_uA < 20000)
196 return REGULATOR_MODE_STANDBY;
197 if (load_uA < 50000)
198 return REGULATOR_MODE_IDLE;
199 return REGULATOR_MODE_NORMAL;
200}
201
202
203static struct regulator_ops wm831x_gp_ldo_ops = {
5ff26a14
MB		 204 .list_voltage = regulator_list_voltage_linear_range,
205 .map_voltage = regulator_map_voltage_linear_range,
ac663b47 206 .get_voltage_sel = regulator_get_voltage_sel_regmap,
0a479689 207 .set_voltage_sel = regulator_set_voltage_sel_regmap,
d1c6b4fe
MB		 208 .set_suspend_voltage = wm831x_gp_ldo_set_suspend_voltage,
209 .get_mode = wm831x_gp_ldo_get_mode,
210 .set_mode = wm831x_gp_ldo_set_mode,
211 .get_status = wm831x_gp_ldo_get_status,
212 .get_optimum_mode = wm831x_gp_ldo_get_optimum_mode,
22c5fb6a
MB		 213 .get_bypass = regulator_get_bypass_regmap,
214 .set_bypass = regulator_set_bypass_regmap,
d1c6b4fe 215
ca8c361b
MB		 216 .is_enabled = regulator_is_enabled_regmap,
217 .enable = regulator_enable_regmap,
218 .disable = regulator_disable_regmap,
d1c6b4fe
MB		 219};
220
a5023574 221static int wm831x_gp_ldo_probe(struct platform_device *pdev)
d1c6b4fe
MB		 222{
223 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
dff91d0b 224 struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
c172708d 225 struct regulator_config config = { };
137a6354 226 int id;
d1c6b4fe
MB		 227 struct wm831x_ldo *ldo;
228 struct resource *res;
229 int ret, irq;
230
137a6354
MB		 231 if (pdata && pdata->wm831x_num)
232 id = (pdata->wm831x_num * 10) + 1;
233 else
234 id = 0;
235 id = pdev->id - id;
236
d1c6b4fe
MB		 237 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
238
fded2f4f 239 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
d1c6b4fe
MB		 240 if (ldo == NULL) {
241 dev_err(&pdev->dev, "Unable to allocate private data\n");
242 return -ENOMEM;
243 }
244
245 ldo->wm831x = wm831x;
246
5656098e 247 res = platform_get_resource(pdev, IORESOURCE_REG, 0);
d1c6b4fe 248 if (res == NULL) {
5656098e 249 dev_err(&pdev->dev, "No REG resource\n");
d1c6b4fe
MB		 250 ret = -EINVAL;
251 goto err;
252 }
253 ldo->base = res->start;
254
255 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
256 ldo->desc.name = ldo->name;
f1aba13f
MB		 257
258 snprintf(ldo->supply_name, sizeof(ldo->supply_name),
259 "LDO%dVDD", id + 1);
260 ldo->desc.supply_name = ldo->supply_name;
261
d1c6b4fe
MB		 262 ldo->desc.id = id;
263 ldo->desc.type = REGULATOR_VOLTAGE;
5ff26a14 264 ldo->desc.n_voltages = 32;
d1c6b4fe
MB		 265 ldo->desc.ops = &wm831x_gp_ldo_ops;
266 ldo->desc.owner = THIS_MODULE;
ac663b47
MB		 267 ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
268 ldo->desc.vsel_mask = WM831X_LDO1_ON_VSEL_MASK;
ca8c361b
MB		 269 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
270 ldo->desc.enable_mask = 1 << id;
22c5fb6a
MB		 271 ldo->desc.bypass_reg = ldo->base;
272 ldo->desc.bypass_mask = WM831X_LDO1_SWI;
5ff26a14
MB		 273 ldo->desc.linear_ranges = wm831x_gp_ldo_ranges;
274 ldo->desc.n_linear_ranges = ARRAY_SIZE(wm831x_gp_ldo_ranges);
d1c6b4fe 275
c172708d 276 config.dev = pdev->dev.parent;
b7ca8788
MB		 277 if (pdata)
278 config.init_data = pdata->ldo[id];
c172708d 279 config.driver_data = ldo;
ac663b47 280 config.regmap = wm831x->regmap;
c172708d
MB		 281
282 ldo->regulator = regulator_register(&ldo->desc, &config);
d1c6b4fe
MB		 283 if (IS_ERR(ldo->regulator)) {
284 ret = PTR_ERR(ldo->regulator);
285 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
286 id + 1, ret);
287 goto err;
288 }
289
cd99758b 290 irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
dfda9c27
MB		 291 ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
292 IRQF_TRIGGER_RISING, ldo->name,
293 ldo);
d1c6b4fe
MB		 294 if (ret != 0) {
295 dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
296 irq, ret);
297 goto err_regulator;
298 }
299
300 platform_set_drvdata(pdev, ldo);
301
302 return 0;
303
304err_regulator:
305 regulator_unregister(ldo->regulator);
306err:
d1c6b4fe
MB		 307 return ret;
308}
309
8dc995f5 310static int wm831x_gp_ldo_remove(struct platform_device *pdev)
d1c6b4fe
MB		 311{
312 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
d1c6b4fe 313
cd99758b
MB		 314 free_irq(wm831x_irq(ldo->wm831x,
315 platform_get_irq_byname(pdev, "UV")), ldo);
d1c6b4fe 316 regulator_unregister(ldo->regulator);
d1c6b4fe
MB		 317
318 return 0;
319}
320
321static struct platform_driver wm831x_gp_ldo_driver = {
322 .probe = wm831x_gp_ldo_probe,
5eb9f2b9 323 .remove = wm831x_gp_ldo_remove,
d1c6b4fe
MB		 324 .driver = {
325 .name = "wm831x-ldo",
eb66d565 326 .owner = THIS_MODULE,
d1c6b4fe
MB		 327 },
328};
329
330/*
331 * Analogue LDOs
332 */
333
5ff26a14
MB		 334static const struct regulator_linear_range wm831x_aldo_ranges[] = {
335 { .min_uV = 1000000, .max_uV = 1650000, .min_sel = 0, .max_sel = 12,
336 .uV_step = 50000 },
337 { .min_uV = 1700000, .max_uV = 3500000, .min_sel = 13, .max_sel = 31,
338 .uV_step = 100000 },
339};
d1c6b4fe
MB		 340
341static int wm831x_aldo_set_suspend_voltage(struct regulator_dev *rdev,
342 int uV)
343{
344 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
0a479689
AL		 345 struct wm831x *wm831x = ldo->wm831x;
346 int sel, reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
347
5ff26a14 348 sel = regulator_map_voltage_linear_range(rdev, uV, uV);
0a479689
AL		 349 if (sel < 0)
350 return sel;
d1c6b4fe 351
0a479689 352 return wm831x_set_bits(wm831x, reg, WM831X_LDO7_ON_VSEL_MASK, sel);
d1c6b4fe
MB		 353}
354
d1c6b4fe
MB		 355static unsigned int wm831x_aldo_get_mode(struct regulator_dev *rdev)
356{
357 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
358 struct wm831x *wm831x = ldo->wm831x;
359 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
6f17c652 360 int ret;
d1c6b4fe
MB		 361
362 ret = wm831x_reg_read(wm831x, on_reg);
363 if (ret < 0)
364 return 0;
365
366 if (ret & WM831X_LDO7_ON_MODE)
367 return REGULATOR_MODE_IDLE;
368 else
369 return REGULATOR_MODE_NORMAL;
370}
371
372static int wm831x_aldo_set_mode(struct regulator_dev *rdev,
373 unsigned int mode)
374{
375 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
376 struct wm831x *wm831x = ldo->wm831x;
d1c6b4fe
MB		 377 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
378 int ret;
379
380
381 switch (mode) {
382 case REGULATOR_MODE_NORMAL:
e841a36a 383 ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE, 0);
d1c6b4fe
MB		 384 if (ret < 0)
385 return ret;
386 break;
387
388 case REGULATOR_MODE_IDLE:
e841a36a 389 ret = wm831x_set_bits(wm831x, on_reg, WM831X_LDO7_ON_MODE,
d1c6b4fe
MB		 390 WM831X_LDO7_ON_MODE);
391 if (ret < 0)
392 return ret;
393 break;
394
395 default:
396 return -EINVAL;
397 }
398
399 return 0;
400}
401
402static int wm831x_aldo_get_status(struct regulator_dev *rdev)
403{
404 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
405 struct wm831x *wm831x = ldo->wm831x;
406 int mask = 1 << rdev_get_id(rdev);
407 int ret;
408
409 /* Is the regulator on? */
410 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
411 if (ret < 0)
412 return ret;
413 if (!(ret & mask))
414 return REGULATOR_STATUS_OFF;
415
416 /* Is it reporting under voltage? */
417 ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
363506cd
AL		 418 if (ret < 0)
419 return ret;
d1c6b4fe
MB		 420 if (ret & mask)
421 return REGULATOR_STATUS_ERROR;
422
423 ret = wm831x_aldo_get_mode(rdev);
424 if (ret < 0)
425 return ret;
426 else
427 return regulator_mode_to_status(ret);
428}
429
430static struct regulator_ops wm831x_aldo_ops = {
5ff26a14
MB		 431 .list_voltage = regulator_list_voltage_linear_range,
432 .map_voltage = regulator_map_voltage_linear_range,
ac663b47 433 .get_voltage_sel = regulator_get_voltage_sel_regmap,
0a479689 434 .set_voltage_sel = regulator_set_voltage_sel_regmap,
d1c6b4fe
MB		 435 .set_suspend_voltage = wm831x_aldo_set_suspend_voltage,
436 .get_mode = wm831x_aldo_get_mode,
437 .set_mode = wm831x_aldo_set_mode,
438 .get_status = wm831x_aldo_get_status,
22c5fb6a
MB		 439 .set_bypass = regulator_set_bypass_regmap,
440 .get_bypass = regulator_get_bypass_regmap,
d1c6b4fe 441
ca8c361b
MB		 442 .is_enabled = regulator_is_enabled_regmap,
443 .enable = regulator_enable_regmap,
444 .disable = regulator_disable_regmap,
d1c6b4fe
MB		 445};
446
a5023574 447static int wm831x_aldo_probe(struct platform_device *pdev)
d1c6b4fe
MB		 448{
449 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
dff91d0b 450 struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
c172708d 451 struct regulator_config config = { };
137a6354 452 int id;
d1c6b4fe
MB		 453 struct wm831x_ldo *ldo;
454 struct resource *res;
455 int ret, irq;
456
137a6354
MB		 457 if (pdata && pdata->wm831x_num)
458 id = (pdata->wm831x_num * 10) + 1;
459 else
460 id = 0;
461 id = pdev->id - id;
462
d1c6b4fe
MB		 463 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
464
fded2f4f 465 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
d1c6b4fe
MB		 466 if (ldo == NULL) {
467 dev_err(&pdev->dev, "Unable to allocate private data\n");
468 return -ENOMEM;
469 }
470
471 ldo->wm831x = wm831x;
472
5656098e 473 res = platform_get_resource(pdev, IORESOURCE_REG, 0);
d1c6b4fe 474 if (res == NULL) {
5656098e 475 dev_err(&pdev->dev, "No REG resource\n");
d1c6b4fe
MB		 476 ret = -EINVAL;
477 goto err;
478 }
479 ldo->base = res->start;
480
481 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
482 ldo->desc.name = ldo->name;
f1aba13f
MB		 483
484 snprintf(ldo->supply_name, sizeof(ldo->supply_name),
485 "LDO%dVDD", id + 1);
486 ldo->desc.supply_name = ldo->supply_name;
487
d1c6b4fe
MB		 488 ldo->desc.id = id;
489 ldo->desc.type = REGULATOR_VOLTAGE;
5ff26a14
MB		 490 ldo->desc.n_voltages = 32;
491 ldo->desc.linear_ranges = wm831x_aldo_ranges;
492 ldo->desc.n_linear_ranges = ARRAY_SIZE(wm831x_aldo_ranges);
d1c6b4fe
MB		 493 ldo->desc.ops = &wm831x_aldo_ops;
494 ldo->desc.owner = THIS_MODULE;
ac663b47
MB		 495 ldo->desc.vsel_reg = ldo->base + WM831X_LDO_ON_CONTROL;
496 ldo->desc.vsel_mask = WM831X_LDO7_ON_VSEL_MASK;
ca8c361b
MB		 497 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
498 ldo->desc.enable_mask = 1 << id;
22c5fb6a
MB		 499 ldo->desc.bypass_reg = ldo->base;
500 ldo->desc.bypass_mask = WM831X_LDO7_SWI;
d1c6b4fe 501
c172708d 502 config.dev = pdev->dev.parent;
b7ca8788
MB		 503 if (pdata)
504 config.init_data = pdata->ldo[id];
c172708d 505 config.driver_data = ldo;
ac663b47 506 config.regmap = wm831x->regmap;
c172708d
MB		 507
508 ldo->regulator = regulator_register(&ldo->desc, &config);
d1c6b4fe
MB		 509 if (IS_ERR(ldo->regulator)) {
510 ret = PTR_ERR(ldo->regulator);
511 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
512 id + 1, ret);
513 goto err;
514 }
515
cd99758b 516 irq = wm831x_irq(wm831x, platform_get_irq_byname(pdev, "UV"));
dfda9c27
MB		 517 ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
518 IRQF_TRIGGER_RISING, ldo->name, ldo);
d1c6b4fe
MB		 519 if (ret != 0) {
520 dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
521 irq, ret);
522 goto err_regulator;
523 }
524
525 platform_set_drvdata(pdev, ldo);
526
527 return 0;
528
529err_regulator:
530 regulator_unregister(ldo->regulator);
531err:
d1c6b4fe
MB		 532 return ret;
533}
534
8dc995f5 535static int wm831x_aldo_remove(struct platform_device *pdev)
d1c6b4fe
MB		 536{
537 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
d1c6b4fe 538
cd99758b
MB		 539 free_irq(wm831x_irq(ldo->wm831x, platform_get_irq_byname(pdev, "UV")),
540 ldo);
d1c6b4fe 541 regulator_unregister(ldo->regulator);
d1c6b4fe
MB		 542
543 return 0;
544}
545
546static struct platform_driver wm831x_aldo_driver = {
547 .probe = wm831x_aldo_probe,
5eb9f2b9 548 .remove = wm831x_aldo_remove,
d1c6b4fe
MB		 549 .driver = {
550 .name = "wm831x-aldo",
eb66d565 551 .owner = THIS_MODULE,
d1c6b4fe
MB		 552 },
553};
554
555/*
556 * Alive LDO
557 */
558
559#define WM831X_ALIVE_LDO_MAX_SELECTOR 0xf
560
d1c6b4fe
MB		 561static int wm831x_alive_ldo_set_suspend_voltage(struct regulator_dev *rdev,
562 int uV)
563{
564 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
0a479689
AL		 565 struct wm831x *wm831x = ldo->wm831x;
566 int sel, reg = ldo->base + WM831X_ALIVE_LDO_SLEEP_CONTROL;
567
568 sel = regulator_map_voltage_linear(rdev, uV, uV);
569 if (sel < 0)
570 return sel;
d1c6b4fe 571
0a479689 572 return wm831x_set_bits(wm831x, reg, WM831X_LDO11_ON_VSEL_MASK, sel);
d1c6b4fe
MB		 573}
574
d1c6b4fe
MB		 575static int wm831x_alive_ldo_get_status(struct regulator_dev *rdev)
576{
577 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
578 struct wm831x *wm831x = ldo->wm831x;
579 int mask = 1 << rdev_get_id(rdev);
580 int ret;
581
582 /* Is the regulator on? */
583 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
584 if (ret < 0)
585 return ret;
586 if (ret & mask)
587 return REGULATOR_STATUS_ON;
588 else
589 return REGULATOR_STATUS_OFF;
590}
591
592static struct regulator_ops wm831x_alive_ldo_ops = {
d31e954e 593 .list_voltage = regulator_list_voltage_linear,
c2543b5f 594 .map_voltage = regulator_map_voltage_linear,
ac663b47 595 .get_voltage_sel = regulator_get_voltage_sel_regmap,
0a479689 596 .set_voltage_sel = regulator_set_voltage_sel_regmap,
d1c6b4fe
MB		 597 .set_suspend_voltage = wm831x_alive_ldo_set_suspend_voltage,
598 .get_status = wm831x_alive_ldo_get_status,
599
ca8c361b
MB		 600 .is_enabled = regulator_is_enabled_regmap,
601 .enable = regulator_enable_regmap,
602 .disable = regulator_disable_regmap,
d1c6b4fe
MB		 603};
604
a5023574 605static int wm831x_alive_ldo_probe(struct platform_device *pdev)
d1c6b4fe
MB		 606{
607 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
dff91d0b 608 struct wm831x_pdata *pdata = dev_get_platdata(wm831x->dev);
c172708d 609 struct regulator_config config = { };
137a6354 610 int id;
d1c6b4fe
MB		 611 struct wm831x_ldo *ldo;
612 struct resource *res;
613 int ret;
614
137a6354
MB		 615 if (pdata && pdata->wm831x_num)
616 id = (pdata->wm831x_num * 10) + 1;
617 else
618 id = 0;
619 id = pdev->id - id;
620
621
d1c6b4fe
MB		 622 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
623
fded2f4f 624 ldo = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_ldo), GFP_KERNEL);
d1c6b4fe
MB		 625 if (ldo == NULL) {
626 dev_err(&pdev->dev, "Unable to allocate private data\n");
627 return -ENOMEM;
628 }
629
630 ldo->wm831x = wm831x;
631
5656098e 632 res = platform_get_resource(pdev, IORESOURCE_REG, 0);
d1c6b4fe 633 if (res == NULL) {
5656098e 634 dev_err(&pdev->dev, "No REG resource\n");
d1c6b4fe
MB		 635 ret = -EINVAL;
636 goto err;
637 }
638 ldo->base = res->start;
639
640 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
641 ldo->desc.name = ldo->name;
f1aba13f
MB		 642
643 snprintf(ldo->supply_name, sizeof(ldo->supply_name),
644 "LDO%dVDD", id + 1);
645 ldo->desc.supply_name = ldo->supply_name;
646
d1c6b4fe
MB		 647 ldo->desc.id = id;
648 ldo->desc.type = REGULATOR_VOLTAGE;
649 ldo->desc.n_voltages = WM831X_ALIVE_LDO_MAX_SELECTOR + 1;
650 ldo->desc.ops = &wm831x_alive_ldo_ops;
651 ldo->desc.owner = THIS_MODULE;
ac663b47
MB		 652 ldo->desc.vsel_reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
653 ldo->desc.vsel_mask = WM831X_LDO11_ON_VSEL_MASK;
ca8c361b
MB		 654 ldo->desc.enable_reg = WM831X_LDO_ENABLE;
655 ldo->desc.enable_mask = 1 << id;
d31e954e
MB		 656 ldo->desc.min_uV = 800000;
657 ldo->desc.uV_step = 50000;
eefaa3c6 658 ldo->desc.enable_time = 1000;
d1c6b4fe 659
c172708d 660 config.dev = pdev->dev.parent;
b7ca8788
MB		 661 if (pdata)
662 config.init_data = pdata->ldo[id];
c172708d 663 config.driver_data = ldo;
ac663b47 664 config.regmap = wm831x->regmap;
c172708d
MB		 665
666 ldo->regulator = regulator_register(&ldo->desc, &config);
d1c6b4fe
MB		 667 if (IS_ERR(ldo->regulator)) {
668 ret = PTR_ERR(ldo->regulator);
669 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
670 id + 1, ret);
671 goto err;
672 }
673
674 platform_set_drvdata(pdev, ldo);
675
676 return 0;
677
678err:
d1c6b4fe
MB		 679 return ret;
680}
681
8dc995f5 682static int wm831x_alive_ldo_remove(struct platform_device *pdev)
d1c6b4fe
MB		 683{
684 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
685
686 regulator_unregister(ldo->regulator);
d1c6b4fe
MB		 687
688 return 0;
689}
690
691static struct platform_driver wm831x_alive_ldo_driver = {
692 .probe = wm831x_alive_ldo_probe,
5eb9f2b9 693 .remove = wm831x_alive_ldo_remove,
d1c6b4fe
MB		 694 .driver = {
695 .name = "wm831x-alive-ldo",
eb66d565 696 .owner = THIS_MODULE,
d1c6b4fe
MB		 697 },
698};
699
700static int __init wm831x_ldo_init(void)
701{
702 int ret;
703
704 ret = platform_driver_register(&wm831x_gp_ldo_driver);
705 if (ret != 0)
706 pr_err("Failed to register WM831x GP LDO driver: %d\n", ret);
707
708 ret = platform_driver_register(&wm831x_aldo_driver);
709 if (ret != 0)
710 pr_err("Failed to register WM831x ALDO driver: %d\n", ret);
711
712 ret = platform_driver_register(&wm831x_alive_ldo_driver);
713 if (ret != 0)
714 pr_err("Failed to register WM831x alive LDO driver: %d\n",
715 ret);
716
717 return 0;
718}
719subsys_initcall(wm831x_ldo_init);
720
721static void __exit wm831x_ldo_exit(void)
722{
723 platform_driver_unregister(&wm831x_alive_ldo_driver);
724 platform_driver_unregister(&wm831x_aldo_driver);
725 platform_driver_unregister(&wm831x_gp_ldo_driver);
726}
727module_exit(wm831x_ldo_exit);
728
729/* Module information */
730MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
731MODULE_DESCRIPTION("WM831x LDO driver");
732MODULE_LICENSE("GPL");
733MODULE_ALIAS("platform:wm831x-ldo");
734MODULE_ALIAS("platform:wm831x-aldo");
735MODULE_ALIAS("platform:wm831x-aliveldo");
Linux kernel - Deliverables
This page took 0.517891 seconds and 5 git commands to generate.