2 * wm8994-gpio.c -- gpiolib support for Wolfson WM8994
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.
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/gpio.h>
18 #include <linux/mfd/core.h>
19 #include <linux/platform_device.h>
20 #include <linux/seq_file.h>
22 #include <linux/mfd/wm8994/core.h>
23 #include <linux/mfd/wm8994/pdata.h>
24 #include <linux/mfd/wm8994/gpio.h>
25 #include <linux/mfd/wm8994/registers.h>
28 struct wm8994
*wm8994
;
29 struct gpio_chip gpio_chip
;
32 static inline struct wm8994_gpio
*to_wm8994_gpio(struct gpio_chip
*chip
)
34 return container_of(chip
, struct wm8994_gpio
, gpio_chip
);
37 static int wm8994_gpio_direction_in(struct gpio_chip
*chip
, unsigned offset
)
39 struct wm8994_gpio
*wm8994_gpio
= to_wm8994_gpio(chip
);
40 struct wm8994
*wm8994
= wm8994_gpio
->wm8994
;
42 return wm8994_set_bits(wm8994
, WM8994_GPIO_1
+ offset
,
43 WM8994_GPN_DIR
, WM8994_GPN_DIR
);
46 static int wm8994_gpio_get(struct gpio_chip
*chip
, unsigned offset
)
48 struct wm8994_gpio
*wm8994_gpio
= to_wm8994_gpio(chip
);
49 struct wm8994
*wm8994
= wm8994_gpio
->wm8994
;
52 ret
= wm8994_reg_read(wm8994
, WM8994_GPIO_1
+ offset
);
56 if (ret
& WM8994_GPN_LVL
)
62 static int wm8994_gpio_direction_out(struct gpio_chip
*chip
,
63 unsigned offset
, int value
)
65 struct wm8994_gpio
*wm8994_gpio
= to_wm8994_gpio(chip
);
66 struct wm8994
*wm8994
= wm8994_gpio
->wm8994
;
68 return wm8994_set_bits(wm8994
, WM8994_GPIO_1
+ offset
,
72 static void wm8994_gpio_set(struct gpio_chip
*chip
, unsigned offset
, int value
)
74 struct wm8994_gpio
*wm8994_gpio
= to_wm8994_gpio(chip
);
75 struct wm8994
*wm8994
= wm8994_gpio
->wm8994
;
78 value
= WM8994_GPN_LVL
;
80 wm8994_set_bits(wm8994
, WM8994_GPIO_1
+ offset
, WM8994_GPN_LVL
, value
);
83 static int wm8994_gpio_to_irq(struct gpio_chip
*chip
, unsigned offset
)
85 struct wm8994_gpio
*wm8994_gpio
= to_wm8994_gpio(chip
);
86 struct wm8994
*wm8994
= wm8994_gpio
->wm8994
;
88 if (!wm8994
->irq_base
)
91 return wm8994
->irq_base
+ offset
;
95 #ifdef CONFIG_DEBUG_FS
96 static void wm8994_gpio_dbg_show(struct seq_file
*s
, struct gpio_chip
*chip
)
98 struct wm8994_gpio
*wm8994_gpio
= to_wm8994_gpio(chip
);
99 struct wm8994
*wm8994
= wm8994_gpio
->wm8994
;
102 for (i
= 0; i
< chip
->ngpio
; i
++) {
103 int gpio
= i
+ chip
->base
;
107 /* We report the GPIO even if it's not requested since
108 * we're also reporting things like alternate
109 * functions which apply even when the GPIO is not in
112 label
= gpiochip_is_requested(chip
, i
);
114 label
= "Unrequested";
116 seq_printf(s
, " gpio-%-3d (%-20.20s) ", gpio
, label
);
118 reg
= wm8994_reg_read(wm8994
, WM8994_GPIO_1
+ i
);
121 "GPIO control %d read failed: %d\n",
127 /* No decode yet; note that GPIO2 is special */
128 seq_printf(s
, "(%x)\n", reg
);
132 #define wm8994_gpio_dbg_show NULL
135 static struct gpio_chip template_chip
= {
137 .owner
= THIS_MODULE
,
138 .direction_input
= wm8994_gpio_direction_in
,
139 .get
= wm8994_gpio_get
,
140 .direction_output
= wm8994_gpio_direction_out
,
141 .set
= wm8994_gpio_set
,
142 .dbg_show
= wm8994_gpio_dbg_show
,
146 static int __devinit
wm8994_gpio_probe(struct platform_device
*pdev
)
148 struct wm8994
*wm8994
= dev_get_drvdata(pdev
->dev
.parent
);
149 struct wm8994_pdata
*pdata
= wm8994
->dev
->platform_data
;
150 struct wm8994_gpio
*wm8994_gpio
;
153 wm8994_gpio
= kzalloc(sizeof(*wm8994_gpio
), GFP_KERNEL
);
154 if (wm8994_gpio
== NULL
)
157 wm8994_gpio
->wm8994
= wm8994
;
158 wm8994_gpio
->gpio_chip
= template_chip
;
159 wm8994_gpio
->gpio_chip
.ngpio
= WM8994_GPIO_MAX
;
160 wm8994_gpio
->gpio_chip
.dev
= &pdev
->dev
;
161 if (pdata
&& pdata
->gpio_base
)
162 wm8994_gpio
->gpio_chip
.base
= pdata
->gpio_base
;
164 wm8994_gpio
->gpio_chip
.base
= -1;
166 ret
= gpiochip_add(&wm8994_gpio
->gpio_chip
);
168 dev_err(&pdev
->dev
, "Could not register gpiochip, %d\n",
173 platform_set_drvdata(pdev
, wm8994_gpio
);
182 static int __devexit
wm8994_gpio_remove(struct platform_device
*pdev
)
184 struct wm8994_gpio
*wm8994_gpio
= platform_get_drvdata(pdev
);
187 ret
= gpiochip_remove(&wm8994_gpio
->gpio_chip
);
194 static struct platform_driver wm8994_gpio_driver
= {
195 .driver
.name
= "wm8994-gpio",
196 .driver
.owner
= THIS_MODULE
,
197 .probe
= wm8994_gpio_probe
,
198 .remove
= __devexit_p(wm8994_gpio_remove
),
201 static int __init
wm8994_gpio_init(void)
203 return platform_driver_register(&wm8994_gpio_driver
);
205 subsys_initcall(wm8994_gpio_init
);
207 static void __exit
wm8994_gpio_exit(void)
209 platform_driver_unregister(&wm8994_gpio_driver
);
211 module_exit(wm8994_gpio_exit
);
213 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
214 MODULE_DESCRIPTION("GPIO interface for WM8994");
215 MODULE_LICENSE("GPL");
216 MODULE_ALIAS("platform:wm8994-gpio");