PageRenderTime 48ms CodeModel.GetById 15ms app.highlight 28ms RepoModel.GetById 0ms app.codeStats 1ms

/drivers/regulator/wm831x-ldo.c

https://bitbucket.org/slukk/jb-tsm-kernel-4.2
C | 873 lines | 676 code | 162 blank | 35 comment | 89 complexity | 93bee46efdad3d8b09379539a2c63516 MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0
  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 = pdev->id % ARRAY_SIZE(pdata->ldo);
314	struct wm831x_ldo *ldo;
315	struct resource *res;
316	int ret, irq;
317
318	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
319
320	if (pdata == NULL || pdata->ldo[id] == NULL)
321		return -ENODEV;
322
323	ldo = kzalloc(sizeof(struct wm831x_ldo), GFP_KERNEL);
324	if (ldo == NULL) {
325		dev_err(&pdev->dev, "Unable to allocate private data\n");
326		return -ENOMEM;
327	}
328
329	ldo->wm831x = wm831x;
330
331	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
332	if (res == NULL) {
333		dev_err(&pdev->dev, "No I/O resource\n");
334		ret = -EINVAL;
335		goto err;
336	}
337	ldo->base = res->start;
338
339	snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
340	ldo->desc.name = ldo->name;
341	ldo->desc.id = id;
342	ldo->desc.type = REGULATOR_VOLTAGE;
343	ldo->desc.n_voltages = WM831X_GP_LDO_MAX_SELECTOR + 1;
344	ldo->desc.ops = &wm831x_gp_ldo_ops;
345	ldo->desc.owner = THIS_MODULE;
346
347	ldo->regulator = regulator_register(&ldo->desc, &pdev->dev,
348					     pdata->ldo[id], ldo);
349	if (IS_ERR(ldo->regulator)) {
350		ret = PTR_ERR(ldo->regulator);
351		dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
352			id + 1, ret);
353		goto err;
354	}
355
356	irq = platform_get_irq_byname(pdev, "UV");
357	ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
358				   IRQF_TRIGGER_RISING, ldo->name,
359				   ldo);
360	if (ret != 0) {
361		dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
362			irq, ret);
363		goto err_regulator;
364	}
365
366	platform_set_drvdata(pdev, ldo);
367
368	return 0;
369
370err_regulator:
371	regulator_unregister(ldo->regulator);
372err:
373	kfree(ldo);
374	return ret;
375}
376
377static __devexit int wm831x_gp_ldo_remove(struct platform_device *pdev)
378{
379	struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
380
381	platform_set_drvdata(pdev, NULL);
382
383	free_irq(platform_get_irq_byname(pdev, "UV"), ldo);
384	regulator_unregister(ldo->regulator);
385	kfree(ldo);
386
387	return 0;
388}
389
390static struct platform_driver wm831x_gp_ldo_driver = {
391	.probe = wm831x_gp_ldo_probe,
392	.remove = __devexit_p(wm831x_gp_ldo_remove),
393	.driver		= {
394		.name	= "wm831x-ldo",
395		.owner	= THIS_MODULE,
396	},
397};
398
399/*
400 * Analogue LDOs
401 */
402
403
404#define WM831X_ALDO_SELECTOR_LOW 0xc
405#define WM831X_ALDO_MAX_SELECTOR 0x1f
406
407static int wm831x_aldo_list_voltage(struct regulator_dev *rdev,
408				      unsigned int selector)
409{
410	/* 1-1.6V in 50mV steps */
411	if (selector <= WM831X_ALDO_SELECTOR_LOW)
412		return 1000000 + (selector * 50000);
413	/* 1.7-3.5V in 50mV steps */
414	if (selector <= WM831X_ALDO_MAX_SELECTOR)
415		return 1600000 + ((selector - WM831X_ALDO_SELECTOR_LOW)
416				  * 100000);
417	return -EINVAL;
418}
419
420static int wm831x_aldo_set_voltage_int(struct regulator_dev *rdev, int reg,
421				       int min_uV, int max_uV,
422				       unsigned *selector)
423{
424	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
425	struct wm831x *wm831x = ldo->wm831x;
426	int vsel, ret;
427
428	if (min_uV < 1000000)
429		vsel = 0;
430	else if (min_uV < 1700000)
431		vsel = ((min_uV - 1000000) / 50000);
432	else
433		vsel = ((min_uV - 1700000) / 100000)
434			+ WM831X_ALDO_SELECTOR_LOW + 1;
435
436	ret = wm831x_aldo_list_voltage(rdev, vsel);
437	if (ret < 0)
438		return ret;
439	if (ret < min_uV || ret > max_uV)
440		return -EINVAL;
441
442	*selector = vsel;
443
444	return wm831x_set_bits(wm831x, reg, WM831X_LDO7_ON_VSEL_MASK, vsel);
445}
446
447static int wm831x_aldo_set_voltage(struct regulator_dev *rdev,
448				   int min_uV, int max_uV, unsigned *selector)
449{
450	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
451	int reg = ldo->base + WM831X_LDO_ON_CONTROL;
452
453	return wm831x_aldo_set_voltage_int(rdev, reg, min_uV, max_uV,
454					   selector);
455}
456
457static int wm831x_aldo_set_suspend_voltage(struct regulator_dev *rdev,
458					     int uV)
459{
460	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
461	int reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
462	unsigned int selector;
463
464	return wm831x_aldo_set_voltage_int(rdev, reg, uV, uV, &selector);
465}
466
467static int wm831x_aldo_get_voltage_sel(struct regulator_dev *rdev)
468{
469	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
470	struct wm831x *wm831x = ldo->wm831x;
471	int reg = ldo->base + WM831X_LDO_ON_CONTROL;
472	int ret;
473
474	ret = wm831x_reg_read(wm831x, reg);
475	if (ret < 0)
476		return ret;
477
478	ret &= WM831X_LDO7_ON_VSEL_MASK;
479
480	return ret;
481}
482
483static unsigned int wm831x_aldo_get_mode(struct regulator_dev *rdev)
484{
485	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
486	struct wm831x *wm831x = ldo->wm831x;
487	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
488	int ret;
489
490	ret = wm831x_reg_read(wm831x, on_reg);
491	if (ret < 0)
492		return 0;
493
494	if (ret & WM831X_LDO7_ON_MODE)
495		return REGULATOR_MODE_IDLE;
496	else
497		return REGULATOR_MODE_NORMAL;
498}
499
500static int wm831x_aldo_set_mode(struct regulator_dev *rdev,
501				  unsigned int mode)
502{
503	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
504	struct wm831x *wm831x = ldo->wm831x;
505	int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
506	int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
507	int ret;
508
509
510	switch (mode) {
511	case REGULATOR_MODE_NORMAL:
512		ret = wm831x_set_bits(wm831x, on_reg,
513				      WM831X_LDO7_ON_MODE, 0);
514		if (ret < 0)
515			return ret;
516		break;
517
518	case REGULATOR_MODE_IDLE:
519		ret = wm831x_set_bits(wm831x, ctrl_reg,
520				      WM831X_LDO7_ON_MODE,
521				      WM831X_LDO7_ON_MODE);
522		if (ret < 0)
523			return ret;
524		break;
525
526	default:
527		return -EINVAL;
528	}
529
530	return 0;
531}
532
533static int wm831x_aldo_get_status(struct regulator_dev *rdev)
534{
535	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
536	struct wm831x *wm831x = ldo->wm831x;
537	int mask = 1 << rdev_get_id(rdev);
538	int ret;
539
540	/* Is the regulator on? */
541	ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
542	if (ret < 0)
543		return ret;
544	if (!(ret & mask))
545		return REGULATOR_STATUS_OFF;
546
547	/* Is it reporting under voltage? */
548	ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
549	if (ret & mask)
550		return REGULATOR_STATUS_ERROR;
551
552	ret = wm831x_aldo_get_mode(rdev);
553	if (ret < 0)
554		return ret;
555	else
556		return regulator_mode_to_status(ret);
557}
558
559static struct regulator_ops wm831x_aldo_ops = {
560	.list_voltage = wm831x_aldo_list_voltage,
561	.get_voltage_sel = wm831x_aldo_get_voltage_sel,
562	.set_voltage = wm831x_aldo_set_voltage,
563	.set_suspend_voltage = wm831x_aldo_set_suspend_voltage,
564	.get_mode = wm831x_aldo_get_mode,
565	.set_mode = wm831x_aldo_set_mode,
566	.get_status = wm831x_aldo_get_status,
567
568	.is_enabled = wm831x_ldo_is_enabled,
569	.enable = wm831x_ldo_enable,
570	.disable = wm831x_ldo_disable,
571};
572
573static __devinit int wm831x_aldo_probe(struct platform_device *pdev)
574{
575	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
576	struct wm831x_pdata *pdata = wm831x->dev->platform_data;
577	int id = pdev->id % ARRAY_SIZE(pdata->ldo);
578	struct wm831x_ldo *ldo;
579	struct resource *res;
580	int ret, irq;
581
582	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
583
584	if (pdata == NULL || pdata->ldo[id] == NULL)
585		return -ENODEV;
586
587	ldo = kzalloc(sizeof(struct wm831x_ldo), GFP_KERNEL);
588	if (ldo == NULL) {
589		dev_err(&pdev->dev, "Unable to allocate private data\n");
590		return -ENOMEM;
591	}
592
593	ldo->wm831x = wm831x;
594
595	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
596	if (res == NULL) {
597		dev_err(&pdev->dev, "No I/O 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	ldo->desc.id = id;
606	ldo->desc.type = REGULATOR_VOLTAGE;
607	ldo->desc.n_voltages = WM831X_ALDO_MAX_SELECTOR + 1;
608	ldo->desc.ops = &wm831x_aldo_ops;
609	ldo->desc.owner = THIS_MODULE;
610
611	ldo->regulator = regulator_register(&ldo->desc, &pdev->dev,
612					     pdata->ldo[id], ldo);
613	if (IS_ERR(ldo->regulator)) {
614		ret = PTR_ERR(ldo->regulator);
615		dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
616			id + 1, ret);
617		goto err;
618	}
619
620	irq = platform_get_irq_byname(pdev, "UV");
621	ret = request_threaded_irq(irq, NULL, wm831x_ldo_uv_irq,
622				   IRQF_TRIGGER_RISING, ldo->name, ldo);
623	if (ret != 0) {
624		dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
625			irq, ret);
626		goto err_regulator;
627	}
628
629	platform_set_drvdata(pdev, ldo);
630
631	return 0;
632
633err_regulator:
634	regulator_unregister(ldo->regulator);
635err:
636	kfree(ldo);
637	return ret;
638}
639
640static __devexit int wm831x_aldo_remove(struct platform_device *pdev)
641{
642	struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
643
644	free_irq(platform_get_irq_byname(pdev, "UV"), ldo);
645	regulator_unregister(ldo->regulator);
646	kfree(ldo);
647
648	return 0;
649}
650
651static struct platform_driver wm831x_aldo_driver = {
652	.probe = wm831x_aldo_probe,
653	.remove = __devexit_p(wm831x_aldo_remove),
654	.driver		= {
655		.name	= "wm831x-aldo",
656		.owner	= THIS_MODULE,
657	},
658};
659
660/*
661 * Alive LDO
662 */
663
664#define WM831X_ALIVE_LDO_MAX_SELECTOR 0xf
665
666static int wm831x_alive_ldo_list_voltage(struct regulator_dev *rdev,
667				      unsigned int selector)
668{
669	/* 0.8-1.55V in 50mV steps */
670	if (selector <= WM831X_ALIVE_LDO_MAX_SELECTOR)
671		return 800000 + (selector * 50000);
672	return -EINVAL;
673}
674
675static int wm831x_alive_ldo_set_voltage_int(struct regulator_dev *rdev,
676					    int reg,
677					    int min_uV, int max_uV,
678					    unsigned *selector)
679{
680	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
681	struct wm831x *wm831x = ldo->wm831x;
682	int vsel, ret;
683
684	vsel = (min_uV - 800000) / 50000;
685
686	ret = wm831x_alive_ldo_list_voltage(rdev, vsel);
687	if (ret < 0)
688		return ret;
689	if (ret < min_uV || ret > max_uV)
690		return -EINVAL;
691
692	*selector = vsel;
693
694	return wm831x_set_bits(wm831x, reg, WM831X_LDO11_ON_VSEL_MASK, vsel);
695}
696
697static int wm831x_alive_ldo_set_voltage(struct regulator_dev *rdev,
698					int min_uV, int max_uV,
699					unsigned *selector)
700{
701	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
702	int reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
703
704	return wm831x_alive_ldo_set_voltage_int(rdev, reg, min_uV, max_uV,
705						selector);
706}
707
708static int wm831x_alive_ldo_set_suspend_voltage(struct regulator_dev *rdev,
709					     int uV)
710{
711	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
712	int reg = ldo->base + WM831X_ALIVE_LDO_SLEEP_CONTROL;
713	unsigned selector;
714
715	return wm831x_alive_ldo_set_voltage_int(rdev, reg, uV, uV, &selector);
716}
717
718static int wm831x_alive_ldo_get_voltage_sel(struct regulator_dev *rdev)
719{
720	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
721	struct wm831x *wm831x = ldo->wm831x;
722	int reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
723	int ret;
724
725	ret = wm831x_reg_read(wm831x, reg);
726	if (ret < 0)
727		return ret;
728
729	ret &= WM831X_LDO11_ON_VSEL_MASK;
730
731	return ret;
732}
733
734static int wm831x_alive_ldo_get_status(struct regulator_dev *rdev)
735{
736	struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
737	struct wm831x *wm831x = ldo->wm831x;
738	int mask = 1 << rdev_get_id(rdev);
739	int ret;
740
741	/* Is the regulator on? */
742	ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
743	if (ret < 0)
744		return ret;
745	if (ret & mask)
746		return REGULATOR_STATUS_ON;
747	else
748		return REGULATOR_STATUS_OFF;
749}
750
751static struct regulator_ops wm831x_alive_ldo_ops = {
752	.list_voltage = wm831x_alive_ldo_list_voltage,
753	.get_voltage_sel = wm831x_alive_ldo_get_voltage_sel,
754	.set_voltage = wm831x_alive_ldo_set_voltage,
755	.set_suspend_voltage = wm831x_alive_ldo_set_suspend_voltage,
756	.get_status = wm831x_alive_ldo_get_status,
757
758	.is_enabled = wm831x_ldo_is_enabled,
759	.enable = wm831x_ldo_enable,
760	.disable = wm831x_ldo_disable,
761};
762
763static __devinit int wm831x_alive_ldo_probe(struct platform_device *pdev)
764{
765	struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
766	struct wm831x_pdata *pdata = wm831x->dev->platform_data;
767	int id = pdev->id % ARRAY_SIZE(pdata->ldo);
768	struct wm831x_ldo *ldo;
769	struct resource *res;
770	int ret;
771
772	dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
773
774	if (pdata == NULL || pdata->ldo[id] == NULL)
775		return -ENODEV;
776
777	ldo = kzalloc(sizeof(struct wm831x_ldo), GFP_KERNEL);
778	if (ldo == NULL) {
779		dev_err(&pdev->dev, "Unable to allocate private data\n");
780		return -ENOMEM;
781	}
782
783	ldo->wm831x = wm831x;
784
785	res = platform_get_resource(pdev, IORESOURCE_IO, 0);
786	if (res == NULL) {
787		dev_err(&pdev->dev, "No I/O resource\n");
788		ret = -EINVAL;
789		goto err;
790	}
791	ldo->base = res->start;
792
793	snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
794	ldo->desc.name = ldo->name;
795	ldo->desc.id = id;
796	ldo->desc.type = REGULATOR_VOLTAGE;
797	ldo->desc.n_voltages = WM831X_ALIVE_LDO_MAX_SELECTOR + 1;
798	ldo->desc.ops = &wm831x_alive_ldo_ops;
799	ldo->desc.owner = THIS_MODULE;
800
801	ldo->regulator = regulator_register(&ldo->desc, &pdev->dev,
802					     pdata->ldo[id], ldo);
803	if (IS_ERR(ldo->regulator)) {
804		ret = PTR_ERR(ldo->regulator);
805		dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
806			id + 1, ret);
807		goto err;
808	}
809
810	platform_set_drvdata(pdev, ldo);
811
812	return 0;
813
814err:
815	kfree(ldo);
816	return ret;
817}
818
819static __devexit int wm831x_alive_ldo_remove(struct platform_device *pdev)
820{
821	struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
822
823	regulator_unregister(ldo->regulator);
824	kfree(ldo);
825
826	return 0;
827}
828
829static struct platform_driver wm831x_alive_ldo_driver = {
830	.probe = wm831x_alive_ldo_probe,
831	.remove = __devexit_p(wm831x_alive_ldo_remove),
832	.driver		= {
833		.name	= "wm831x-alive-ldo",
834		.owner	= THIS_MODULE,
835	},
836};
837
838static int __init wm831x_ldo_init(void)
839{
840	int ret;
841
842	ret = platform_driver_register(&wm831x_gp_ldo_driver);
843	if (ret != 0)
844		pr_err("Failed to register WM831x GP LDO driver: %d\n", ret);
845
846	ret = platform_driver_register(&wm831x_aldo_driver);
847	if (ret != 0)
848		pr_err("Failed to register WM831x ALDO driver: %d\n", ret);
849
850	ret = platform_driver_register(&wm831x_alive_ldo_driver);
851	if (ret != 0)
852		pr_err("Failed to register WM831x alive LDO driver: %d\n",
853		       ret);
854
855	return 0;
856}
857subsys_initcall(wm831x_ldo_init);
858
859static void __exit wm831x_ldo_exit(void)
860{
861	platform_driver_unregister(&wm831x_alive_ldo_driver);
862	platform_driver_unregister(&wm831x_aldo_driver);
863	platform_driver_unregister(&wm831x_gp_ldo_driver);
864}
865module_exit(wm831x_ldo_exit);
866
867/* Module information */
868MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
869MODULE_DESCRIPTION("WM831x LDO driver");
870MODULE_LICENSE("GPL");
871MODULE_ALIAS("platform:wm831x-ldo");
872MODULE_ALIAS("platform:wm831x-aldo");
873MODULE_ALIAS("platform:wm831x-aliveldo");