2 * wm831x-ldo.c -- LDO driver for the WM831x series
4 * Copyright 2009 Wolfson Microelectronics PLC.
6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
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.
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>
24 #include <linux/mfd/wm831x/core.h>
25 #include <linux/mfd/wm831x/regulator.h>
26 #include <linux/mfd/wm831x/pdata.h>
28 //#define WM831X_LDO_MAX_NAME 6
30 #define WM831X_LDO_CONTROL 0
31 #define WM831X_LDO_ON_CONTROL 1
32 #define WM831X_LDO_SLEEP_CONTROL 2
34 #define WM831X_ALIVE_LDO_ON_CONTROL 0
35 #define WM831X_ALIVE_LDO_SLEEP_CONTROL 1
39 char name[WM831X_LDO_MAX_NAME];
40 struct regulator_desc desc;
42 struct wm831x *wm831x;
43 struct regulator_dev *regulator;
50 extern int reboot_cmd_get(void);
51 static int wm831x_ldo_is_enabled(struct regulator_dev *rdev)
53 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
54 struct wm831x *wm831x = ldo->wm831x;
55 int mask = 1 << rdev_get_id(rdev);
58 reg = wm831x_reg_read(wm831x, WM831X_LDO_ENABLE);
68 static int wm831x_ldo_enable(struct regulator_dev *rdev)
70 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
71 struct wm831x *wm831x = ldo->wm831x;
72 int mask = 1 << rdev_get_id(rdev);
73 //printk("%s,%x\n", __FUNCTION__,mask);
74 return wm831x_set_bits(wm831x, WM831X_LDO_ENABLE, mask, mask);
77 static int wm831x_ldo_disable(struct regulator_dev *rdev)
79 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
80 struct wm831x *wm831x = ldo->wm831x;
81 int mask = 1 << rdev_get_id(rdev);
82 //printk("%s\n", __FUNCTION__);
83 return wm831x_set_bits(wm831x, WM831X_LDO_ENABLE, mask, 0);
86 static irqreturn_t wm831x_ldo_uv_irq(int irq, void *data)
88 struct wm831x_ldo *ldo = data;
90 regulator_notifier_call_chain(ldo->regulator,
91 REGULATOR_EVENT_UNDER_VOLTAGE,
98 * General purpose LDOs
101 #define WM831X_GP_LDO_SELECTOR_LOW 0xe
102 #define WM831X_GP_LDO_MAX_SELECTOR 0x1f
104 static int wm831x_gp_ldo_list_voltage(struct regulator_dev *rdev,
105 unsigned int selector)
107 /* 0.9-1.6V in 50mV steps */
108 if (selector <= WM831X_GP_LDO_SELECTOR_LOW)
109 return 900000 + (selector * 50000);
110 /* 1.7-3.3V in 50mV steps */
111 if (selector <= WM831X_GP_LDO_MAX_SELECTOR)
112 return 1600000 + ((selector - WM831X_GP_LDO_SELECTOR_LOW)
117 static int wm831x_gp_ldo_set_voltage_int(struct regulator_dev *rdev, int reg,
118 int min_uV, int max_uV)
120 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
121 struct wm831x *wm831x = ldo->wm831x;
126 else if (min_uV < 1700000)
127 vsel = ((min_uV - 900000) / 50000);
129 vsel = ((min_uV - 1700000) / 100000)
130 + WM831X_GP_LDO_SELECTOR_LOW + 1;
132 ret = wm831x_gp_ldo_list_voltage(rdev, vsel);
135 if (ret < min_uV || ret > max_uV)
138 return wm831x_set_bits(wm831x, reg, WM831X_LDO1_ON_VSEL_MASK, vsel);
141 static int wm831x_gp_ldo_set_voltage(struct regulator_dev *rdev,
142 int min_uV, int max_uV, unsigned *selector)
144 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
145 int reg = ldo->base + WM831X_LDO_ON_CONTROL;
146 //printk("%s base=%x,%d,%d\n", __FUNCTION__,ldo->base,min_uV,max_uV);
147 return wm831x_gp_ldo_set_voltage_int(rdev, reg, min_uV, max_uV);
150 static int wm831x_gp_ldo_set_suspend_voltage(struct regulator_dev *rdev,
153 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
154 int reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
156 return wm831x_gp_ldo_set_voltage_int(rdev, reg, uV, uV);
159 static int wm831x_gp_ldo_get_voltage(struct regulator_dev *rdev)
161 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
162 struct wm831x *wm831x = ldo->wm831x;
163 int reg = ldo->base + WM831X_LDO_ON_CONTROL;
166 ret = wm831x_reg_read(wm831x, reg);
169 //printk("%s base=%x,ret=%x\n", __FUNCTION__,ldo->base,ret);
170 ret &= WM831X_LDO1_ON_VSEL_MASK;
172 return wm831x_gp_ldo_list_voltage(rdev, ret);
175 static unsigned int wm831x_gp_ldo_get_mode(struct regulator_dev *rdev)
177 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
178 struct wm831x *wm831x = ldo->wm831x;
179 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
180 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
183 ret = wm831x_reg_read(wm831x, on_reg);
187 if (!(ret & WM831X_LDO1_ON_MODE))
188 return REGULATOR_MODE_NORMAL;
190 ret = wm831x_reg_read(wm831x, ctrl_reg);
194 if (ret & WM831X_LDO1_LP_MODE)
195 return REGULATOR_MODE_STANDBY;
197 return REGULATOR_MODE_IDLE;
200 static int wm831x_gp_ldo_set_mode(struct regulator_dev *rdev,
203 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
204 struct wm831x *wm831x = ldo->wm831x;
205 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
206 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
209 // printk("%s base=%x,mode=%x\n", __FUNCTION__,ldo->base,mode);
211 case REGULATOR_MODE_NORMAL:
212 ret = wm831x_set_bits(wm831x, on_reg,
213 WM831X_LDO1_ON_MODE, 0);
218 case REGULATOR_MODE_IDLE:
219 ret = wm831x_set_bits(wm831x, ctrl_reg,
220 WM831X_LDO1_LP_MODE, 0);
224 ret = wm831x_set_bits(wm831x, on_reg,
226 WM831X_LDO1_ON_MODE);
231 case REGULATOR_MODE_STANDBY:
232 ret = wm831x_set_bits(wm831x, ctrl_reg,
234 WM831X_LDO1_LP_MODE);
238 ret = wm831x_set_bits(wm831x, on_reg,
240 WM831X_LDO1_ON_MODE);
252 static int wm831x_gp_ldo_get_status(struct regulator_dev *rdev)
254 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
255 struct wm831x *wm831x = ldo->wm831x;
256 int mask = 1 << rdev_get_id(rdev);
259 /* Is the regulator on? */
260 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
264 return REGULATOR_STATUS_OFF;
266 /* Is it reporting under voltage? */
267 ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
269 return REGULATOR_STATUS_ERROR;
271 ret = wm831x_gp_ldo_get_mode(rdev);
275 return regulator_mode_to_status(ret);
278 static unsigned int wm831x_gp_ldo_get_optimum_mode(struct regulator_dev *rdev,
280 int output_uV, int load_uA)
283 return REGULATOR_MODE_STANDBY;
285 return REGULATOR_MODE_IDLE;
286 return REGULATOR_MODE_NORMAL;
289 int wm831x_ldo_set_suspend_enable(struct regulator_dev *rdev)
294 int wm831x_ldo_set_suspend_disable(struct regulator_dev *rdev)
300 static struct regulator_ops wm831x_gp_ldo_ops = {
301 .list_voltage = wm831x_gp_ldo_list_voltage,
302 .get_voltage = wm831x_gp_ldo_get_voltage,
303 .set_voltage = wm831x_gp_ldo_set_voltage,
304 .set_suspend_voltage = wm831x_gp_ldo_set_suspend_voltage,
305 .get_mode = wm831x_gp_ldo_get_mode,
306 .set_mode = wm831x_gp_ldo_set_mode,
307 .get_status = wm831x_gp_ldo_get_status,
308 .get_optimum_mode = wm831x_gp_ldo_get_optimum_mode,
310 .is_enabled = wm831x_ldo_is_enabled,
311 .enable = wm831x_ldo_enable,
312 .disable = wm831x_ldo_disable,
313 .set_suspend_enable = wm831x_ldo_set_suspend_enable,
314 .set_suspend_disable = wm831x_ldo_set_suspend_disable,
317 static __devinit int wm831x_gp_ldo_probe(struct platform_device *pdev)
319 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
320 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
321 int id = pdev->id % ARRAY_SIZE(pdata->ldo);
322 struct wm831x_ldo *ldo;
323 struct resource *res;
326 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
327 // printk("Probing LDO%d\n", id + 1);
328 if (pdata == NULL || pdata->ldo[id] == NULL)
331 ldo = kzalloc(sizeof(struct wm831x_ldo), GFP_KERNEL);
333 dev_err(&pdev->dev, "Unable to allocate private data\n");
337 ldo->wm831x = wm831x;
339 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
341 dev_err(&pdev->dev, "No I/O resource\n");
345 ldo->base = res->start;
347 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
348 ldo->desc.name = ldo->name;
350 ldo->desc.type = REGULATOR_VOLTAGE;
351 ldo->desc.n_voltages = WM831X_GP_LDO_MAX_SELECTOR + 1;
352 ldo->desc.ops = &wm831x_gp_ldo_ops;
353 ldo->desc.owner = THIS_MODULE;
355 ldo->regulator = regulator_register(&ldo->desc, &pdev->dev,
356 pdata->ldo[id], ldo);
357 if (IS_ERR(ldo->regulator)) {
358 ret = PTR_ERR(ldo->regulator);
359 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
364 irq = platform_get_irq_byname(pdev, "UV");
365 ret = wm831x_request_irq(wm831x, irq, wm831x_ldo_uv_irq,
366 IRQF_TRIGGER_RISING, ldo->name,
369 dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
374 platform_set_drvdata(pdev, ldo);
379 regulator_unregister(ldo->regulator);
385 static __devexit int wm831x_gp_ldo_remove(struct platform_device *pdev)
387 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
388 struct wm831x *wm831x = ldo->wm831x;
390 platform_set_drvdata(pdev, NULL);
392 wm831x_free_irq(wm831x, platform_get_irq_byname(pdev, "UV"), ldo);
393 regulator_unregister(ldo->regulator);
399 static struct platform_driver wm831x_gp_ldo_driver = {
400 .probe = wm831x_gp_ldo_probe,
401 .remove = __devexit_p(wm831x_gp_ldo_remove),
403 .name = "wm831x-ldo",
404 .owner = THIS_MODULE,
413 #define WM831X_ALDO_SELECTOR_LOW 0xc
414 #define WM831X_ALDO_MAX_SELECTOR 0x1f
416 static int wm831x_aldo_list_voltage(struct regulator_dev *rdev,
417 unsigned int selector)
419 /* 1-1.6V in 50mV steps */
420 if (selector <= WM831X_ALDO_SELECTOR_LOW)
421 return 1000000 + (selector * 50000);
422 /* 1.7-3.5V in 50mV steps */
423 if (selector <= WM831X_ALDO_MAX_SELECTOR)
424 return 1600000 + ((selector - WM831X_ALDO_SELECTOR_LOW)
429 static int wm831x_aldo_set_voltage_int(struct regulator_dev *rdev, int reg,
430 int min_uV, int max_uV)
432 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
433 struct wm831x *wm831x = ldo->wm831x;
436 if (min_uV < 1000000)
438 else if (min_uV < 1700000)
439 vsel = ((min_uV - 1000000) / 50000);
441 vsel = ((min_uV - 1700000) / 100000)
442 + WM831X_ALDO_SELECTOR_LOW + 1;
444 ret = wm831x_aldo_list_voltage(rdev, vsel);
447 if (ret < min_uV || ret > max_uV)
450 return wm831x_set_bits(wm831x, reg, WM831X_LDO7_ON_VSEL_MASK, vsel);
453 static int wm831x_aldo_set_voltage(struct regulator_dev *rdev,
454 int min_uV, int max_uV, unsigned *selector)
456 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
457 int reg = ldo->base + WM831X_LDO_ON_CONTROL;
458 //printk("%s base=%x,min_uV=%d,%d\n", __FUNCTION__,ldo->base,min_uV,max_uV);
459 return wm831x_aldo_set_voltage_int(rdev, reg, min_uV, max_uV);
462 static int wm831x_aldo_set_suspend_voltage(struct regulator_dev *rdev,
465 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
466 int reg = ldo->base + WM831X_LDO_SLEEP_CONTROL;
468 return wm831x_aldo_set_voltage_int(rdev, reg, uV, uV);
471 static int wm831x_aldo_get_voltage(struct regulator_dev *rdev)
473 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
474 struct wm831x *wm831x = ldo->wm831x;
475 int reg = ldo->base + WM831X_LDO_ON_CONTROL;
478 ret = wm831x_reg_read(wm831x, reg);
481 printk("%s base=%x,ret=%x\n", __FUNCTION__,ldo->base,ret);
482 ret &= WM831X_LDO7_ON_VSEL_MASK;
484 return wm831x_aldo_list_voltage(rdev, ret);
487 static unsigned int wm831x_aldo_get_mode(struct regulator_dev *rdev)
489 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
490 struct wm831x *wm831x = ldo->wm831x;
491 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
494 ret = wm831x_reg_read(wm831x, on_reg);
498 if (ret & WM831X_LDO7_ON_MODE)
499 return REGULATOR_MODE_IDLE;
501 return REGULATOR_MODE_NORMAL;
504 static int wm831x_aldo_set_mode(struct regulator_dev *rdev,
507 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
508 struct wm831x *wm831x = ldo->wm831x;
509 int ctrl_reg = ldo->base + WM831X_LDO_CONTROL;
510 int on_reg = ldo->base + WM831X_LDO_ON_CONTROL;
515 case REGULATOR_MODE_NORMAL:
516 ret = wm831x_set_bits(wm831x, on_reg,
517 WM831X_LDO7_ON_MODE, 0);
522 case REGULATOR_MODE_IDLE:
523 ret = wm831x_set_bits(wm831x, ctrl_reg,
525 WM831X_LDO7_ON_MODE);
537 static int wm831x_aldo_get_status(struct regulator_dev *rdev)
539 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
540 struct wm831x *wm831x = ldo->wm831x;
541 int mask = 1 << rdev_get_id(rdev);
544 /* Is the regulator on? */
545 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
549 return REGULATOR_STATUS_OFF;
551 /* Is it reporting under voltage? */
552 ret = wm831x_reg_read(wm831x, WM831X_LDO_UV_STATUS);
554 return REGULATOR_STATUS_ERROR;
556 ret = wm831x_aldo_get_mode(rdev);
560 return regulator_mode_to_status(ret);
563 static struct regulator_ops wm831x_aldo_ops = {
564 .list_voltage = wm831x_aldo_list_voltage,
565 .get_voltage = wm831x_aldo_get_voltage,
566 .set_voltage = wm831x_aldo_set_voltage,
567 .set_suspend_voltage = wm831x_aldo_set_suspend_voltage,
568 .get_mode = wm831x_aldo_get_mode,
569 .set_mode = wm831x_aldo_set_mode,
570 .get_status = wm831x_aldo_get_status,
572 .is_enabled = wm831x_ldo_is_enabled,
573 .enable = wm831x_ldo_enable,
574 .disable = wm831x_ldo_disable,
575 .set_suspend_enable = wm831x_ldo_set_suspend_enable,
576 .set_suspend_disable = wm831x_ldo_set_suspend_disable,
579 static __devinit int wm831x_aldo_probe(struct platform_device *pdev)
581 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
582 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
583 int id = pdev->id % ARRAY_SIZE(pdata->ldo);
584 struct wm831x_ldo *ldo;
585 struct resource *res;
588 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
589 // printk("Probing LDO%d--\n", id + 1);
590 if (pdata == NULL || pdata->ldo[id] == NULL)
593 ldo = kzalloc(sizeof(struct wm831x_ldo), GFP_KERNEL);
595 dev_err(&pdev->dev, "Unable to allocate private data\n");
599 ldo->wm831x = wm831x;
601 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
603 dev_err(&pdev->dev, "No I/O resource\n");
607 ldo->base = res->start;
609 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
610 ldo->desc.name = ldo->name;
612 ldo->desc.type = REGULATOR_VOLTAGE;
613 ldo->desc.n_voltages = WM831X_ALDO_MAX_SELECTOR + 1;
614 ldo->desc.ops = &wm831x_aldo_ops;
615 ldo->desc.owner = THIS_MODULE;
617 ldo->regulator = regulator_register(&ldo->desc, &pdev->dev,
618 pdata->ldo[id], ldo);
619 if (IS_ERR(ldo->regulator)) {
620 ret = PTR_ERR(ldo->regulator);
621 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
626 irq = platform_get_irq_byname(pdev, "UV");
627 ret = wm831x_request_irq(wm831x, irq, wm831x_ldo_uv_irq,
628 IRQF_TRIGGER_RISING, ldo->name,
631 dev_err(&pdev->dev, "Failed to request UV IRQ %d: %d\n",
636 platform_set_drvdata(pdev, ldo);
641 regulator_unregister(ldo->regulator);
647 static __devexit int wm831x_aldo_remove(struct platform_device *pdev)
649 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
650 struct wm831x *wm831x = ldo->wm831x;
652 wm831x_free_irq(wm831x, platform_get_irq_byname(pdev, "UV"), ldo);
653 regulator_unregister(ldo->regulator);
659 static struct platform_driver wm831x_aldo_driver = {
660 .probe = wm831x_aldo_probe,
661 .remove = __devexit_p(wm831x_aldo_remove),
663 .name = "wm831x-aldo",
664 .owner = THIS_MODULE,
672 #define WM831X_ALIVE_LDO_MAX_SELECTOR 0xf
674 static int wm831x_alive_ldo_list_voltage(struct regulator_dev *rdev,
675 unsigned int selector)
677 /* 0.8-1.55V in 50mV steps */
678 if (selector <= WM831X_ALIVE_LDO_MAX_SELECTOR)
679 return 800000 + (selector * 50000);
683 static int wm831x_alive_ldo_set_voltage_int(struct regulator_dev *rdev,
685 int min_uV, int max_uV)
687 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
688 struct wm831x *wm831x = ldo->wm831x;
691 vsel = (min_uV - 800000) / 50000;
693 ret = wm831x_alive_ldo_list_voltage(rdev, vsel);
696 if (ret < min_uV || ret > max_uV)
699 return wm831x_set_bits(wm831x, reg, WM831X_LDO11_ON_VSEL_MASK, vsel);
702 static int wm831x_alive_ldo_set_voltage(struct regulator_dev *rdev,
703 int min_uV, int max_uV, unsigned *selector)
705 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
706 int reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
708 return wm831x_alive_ldo_set_voltage_int(rdev, reg, min_uV, max_uV);
711 static int wm831x_alive_ldo_set_suspend_voltage(struct regulator_dev *rdev,
714 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
715 int reg = ldo->base + WM831X_ALIVE_LDO_SLEEP_CONTROL;
717 return wm831x_alive_ldo_set_voltage_int(rdev, reg, uV, uV);
720 static int wm831x_alive_ldo_get_voltage(struct regulator_dev *rdev)
722 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
723 struct wm831x *wm831x = ldo->wm831x;
724 int reg = ldo->base + WM831X_ALIVE_LDO_ON_CONTROL;
727 ret = wm831x_reg_read(wm831x, reg);
731 ret &= WM831X_LDO11_ON_VSEL_MASK;
733 return wm831x_alive_ldo_list_voltage(rdev, ret);
736 static int wm831x_alive_ldo_get_status(struct regulator_dev *rdev)
738 struct wm831x_ldo *ldo = rdev_get_drvdata(rdev);
739 struct wm831x *wm831x = ldo->wm831x;
740 int mask = 1 << rdev_get_id(rdev);
743 /* Is the regulator on? */
744 ret = wm831x_reg_read(wm831x, WM831X_LDO_STATUS);
748 return REGULATOR_STATUS_ON;
750 return REGULATOR_STATUS_OFF;
753 static struct regulator_ops wm831x_alive_ldo_ops = {
754 .list_voltage = wm831x_alive_ldo_list_voltage,
755 .get_voltage = wm831x_alive_ldo_get_voltage,
756 .set_voltage = wm831x_alive_ldo_set_voltage,
757 .set_suspend_voltage = wm831x_alive_ldo_set_suspend_voltage,
758 .get_status = wm831x_alive_ldo_get_status,
760 .is_enabled = wm831x_ldo_is_enabled,
761 .enable = wm831x_ldo_enable,
762 .disable = wm831x_ldo_disable,
763 .set_suspend_enable = wm831x_ldo_set_suspend_enable,
764 .set_suspend_disable = wm831x_ldo_set_suspend_disable,
767 static __devinit int wm831x_alive_ldo_probe(struct platform_device *pdev)
769 struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent);
770 struct wm831x_pdata *pdata = wm831x->dev->platform_data;
771 int id = pdev->id % ARRAY_SIZE(pdata->ldo);
772 struct wm831x_ldo *ldo;
773 struct resource *res;
776 dev_dbg(&pdev->dev, "Probing LDO%d\n", id + 1);
777 // printk("wm831x_alive_ldo_probe Probing LDO%d\n", id + 1);
778 if (pdata == NULL || pdata->ldo[id] == NULL)
781 ldo = kzalloc(sizeof(struct wm831x_ldo), GFP_KERNEL);
783 dev_err(&pdev->dev, "Unable to allocate private data\n");
787 ldo->wm831x = wm831x;
789 res = platform_get_resource(pdev, IORESOURCE_IO, 0);
791 dev_err(&pdev->dev, "No I/O resource\n");
795 ldo->base = res->start;
797 snprintf(ldo->name, sizeof(ldo->name), "LDO%d", id + 1);
798 ldo->desc.name = ldo->name;
800 ldo->desc.type = REGULATOR_VOLTAGE;
801 ldo->desc.n_voltages = WM831X_ALIVE_LDO_MAX_SELECTOR + 1;
802 ldo->desc.ops = &wm831x_alive_ldo_ops;
803 ldo->desc.owner = THIS_MODULE;
805 ldo->regulator = regulator_register(&ldo->desc, &pdev->dev,
806 pdata->ldo[id], ldo);
807 if (IS_ERR(ldo->regulator)) {
808 ret = PTR_ERR(ldo->regulator);
809 dev_err(wm831x->dev, "Failed to register LDO%d: %d\n",
814 platform_set_drvdata(pdev, ldo);
823 static __devexit int wm831x_alive_ldo_remove(struct platform_device *pdev)
825 struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
827 regulator_unregister(ldo->regulator);
833 static __devexit void wm831x_alive_ldo_shutdown(struct platform_device *pdev) /*ZMF*/
835 //struct wm831x_ldo *ldo = platform_get_drvdata(pdev);
837 //close ldo in wm831x_last_deinit()
838 struct regulator* ldo;
840 //if (reboot_cmd_get())
842 printk("%s\n", __FUNCTION__);
844 ldo = regulator_get(NULL, "ldo1");
845 regulator_disable(ldo);
848 ldo = regulator_get(NULL, "ldo2");
849 regulator_disable(ldo);
852 ldo = regulator_get(NULL, "ldo3");
853 regulator_disable(ldo);
856 ldo = regulator_get(NULL, "ldo4");
857 //regulator_disable(ldo);
860 ldo = regulator_get(NULL, "ldo5");
861 regulator_disable(ldo);
864 ldo = regulator_get(NULL, "ldo6");
865 regulator_disable(ldo);
868 ldo = regulator_get(NULL, "ldo7");
869 regulator_disable(ldo);
872 ldo = regulator_get(NULL, "ldo8");
873 //regulator_disable(ldo);
876 ldo = regulator_get(NULL, "ldo9");
877 regulator_disable(ldo);
880 ldo = regulator_get(NULL, "ldo10");
881 regulator_disable(ldo);
886 static struct platform_driver wm831x_alive_ldo_driver = {
887 .probe = wm831x_alive_ldo_probe,
888 .remove = __devexit_p(wm831x_alive_ldo_remove),
889 .shutdown = __devexit_p(wm831x_alive_ldo_shutdown),
891 .name = "wm831x-alive-ldo",
892 .owner = THIS_MODULE,
896 static int __init wm831x_ldo_init(void)
899 printk("%s \n", __FUNCTION__);
900 ret = platform_driver_register(&wm831x_gp_ldo_driver);
902 pr_err("Failed to register WM831x GP LDO driver: %d\n", ret);
904 ret = platform_driver_register(&wm831x_aldo_driver);
906 pr_err("Failed to register WM831x ALDO driver: %d\n", ret);
908 ret = platform_driver_register(&wm831x_alive_ldo_driver);
910 pr_err("Failed to register WM831x alive LDO driver: %d\n",
914 subsys_initcall(wm831x_ldo_init);
916 static void __exit wm831x_ldo_exit(void)
918 platform_driver_unregister(&wm831x_alive_ldo_driver);
919 platform_driver_unregister(&wm831x_aldo_driver);
920 platform_driver_unregister(&wm831x_gp_ldo_driver);
922 module_exit(wm831x_ldo_exit);
924 /* Module information */
925 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
926 MODULE_DESCRIPTION("WM831x LDO driver");
927 MODULE_LICENSE("GPL");
928 MODULE_ALIAS("platform:wm831x-ldo");
929 MODULE_ALIAS("platform:wm831x-aldo");
930 MODULE_ALIAS("platform:wm831x-aliveldo");