1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * gpiolib support for Wolfson WM8994
4 *
5 * Copyright 2009 Wolfson Microelectronics PLC.
6 *
7 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
8 *
9 */
10
11 #include <linux/kernel.h>
12 #include <linux/slab.h>
13 #include <linux/module.h>
14 #include <linux/gpio/driver.h>
15 #include <linux/mfd/core.h>
16 #include <linux/platform_device.h>
17 #include <linux/seq_file.h>
18 #include <linux/regmap.h>
19
20 #include <linux/mfd/wm8994/core.h>
21 #include <linux/mfd/wm8994/pdata.h>
22 #include <linux/mfd/wm8994/gpio.h>
23 #include <linux/mfd/wm8994/registers.h>
24
25 struct wm8994_gpio {
26 struct wm8994 *wm8994;
27 struct gpio_chip gpio_chip;
28 };
29
wm8994_gpio_request(struct gpio_chip * chip,unsigned offset)30 static int wm8994_gpio_request(struct gpio_chip *chip, unsigned offset)
31 {
32 struct wm8994_gpio *wm8994_gpio = gpiochip_get_data(chip);
33 struct wm8994 *wm8994 = wm8994_gpio->wm8994;
34
35 switch (wm8994->type) {
36 case WM8958:
37 switch (offset) {
38 case 1:
39 case 2:
40 case 3:
41 case 4:
42 case 6:
43 return -EINVAL;
44 }
45 break;
46 default:
47 break;
48 }
49
50 return 0;
51 }
52
wm8994_gpio_direction_in(struct gpio_chip * chip,unsigned offset)53 static int wm8994_gpio_direction_in(struct gpio_chip *chip, unsigned offset)
54 {
55 struct wm8994_gpio *wm8994_gpio = gpiochip_get_data(chip);
56 struct wm8994 *wm8994 = wm8994_gpio->wm8994;
57
58 return wm8994_set_bits(wm8994, WM8994_GPIO_1 + offset,
59 WM8994_GPN_DIR, WM8994_GPN_DIR);
60 }
61
wm8994_gpio_get(struct gpio_chip * chip,unsigned offset)62 static int wm8994_gpio_get(struct gpio_chip *chip, unsigned offset)
63 {
64 struct wm8994_gpio *wm8994_gpio = gpiochip_get_data(chip);
65 struct wm8994 *wm8994 = wm8994_gpio->wm8994;
66 int ret;
67
68 ret = wm8994_reg_read(wm8994, WM8994_GPIO_1 + offset);
69 if (ret < 0)
70 return ret;
71
72 if (ret & WM8994_GPN_LVL)
73 return 1;
74 else
75 return 0;
76 }
77
wm8994_gpio_direction_out(struct gpio_chip * chip,unsigned offset,int value)78 static int wm8994_gpio_direction_out(struct gpio_chip *chip,
79 unsigned offset, int value)
80 {
81 struct wm8994_gpio *wm8994_gpio = gpiochip_get_data(chip);
82 struct wm8994 *wm8994 = wm8994_gpio->wm8994;
83
84 if (value)
85 value = WM8994_GPN_LVL;
86
87 return wm8994_set_bits(wm8994, WM8994_GPIO_1 + offset,
88 WM8994_GPN_DIR | WM8994_GPN_LVL, value);
89 }
90
wm8994_gpio_set(struct gpio_chip * chip,unsigned offset,int value)91 static void wm8994_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
92 {
93 struct wm8994_gpio *wm8994_gpio = gpiochip_get_data(chip);
94 struct wm8994 *wm8994 = wm8994_gpio->wm8994;
95
96 if (value)
97 value = WM8994_GPN_LVL;
98
99 wm8994_set_bits(wm8994, WM8994_GPIO_1 + offset, WM8994_GPN_LVL, value);
100 }
101
wm8994_gpio_set_config(struct gpio_chip * chip,unsigned int offset,unsigned long config)102 static int wm8994_gpio_set_config(struct gpio_chip *chip, unsigned int offset,
103 unsigned long config)
104 {
105 struct wm8994_gpio *wm8994_gpio = gpiochip_get_data(chip);
106 struct wm8994 *wm8994 = wm8994_gpio->wm8994;
107
108 switch (pinconf_to_config_param(config)) {
109 case PIN_CONFIG_DRIVE_OPEN_DRAIN:
110 return wm8994_set_bits(wm8994, WM8994_GPIO_1 + offset,
111 WM8994_GPN_OP_CFG_MASK,
112 WM8994_GPN_OP_CFG);
113 case PIN_CONFIG_DRIVE_PUSH_PULL:
114 return wm8994_set_bits(wm8994, WM8994_GPIO_1 + offset,
115 WM8994_GPN_OP_CFG_MASK, 0);
116 default:
117 break;
118 }
119
120 return -ENOTSUPP;
121 }
122
wm8994_gpio_to_irq(struct gpio_chip * chip,unsigned offset)123 static int wm8994_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
124 {
125 struct wm8994_gpio *wm8994_gpio = gpiochip_get_data(chip);
126 struct wm8994 *wm8994 = wm8994_gpio->wm8994;
127
128 return regmap_irq_get_virq(wm8994->irq_data, offset);
129 }
130
131
132 #ifdef CONFIG_DEBUG_FS
wm8994_gpio_fn(u16 fn)133 static const char *wm8994_gpio_fn(u16 fn)
134 {
135 switch (fn) {
136 case WM8994_GP_FN_PIN_SPECIFIC:
137 return "pin-specific";
138 case WM8994_GP_FN_GPIO:
139 return "GPIO";
140 case WM8994_GP_FN_SDOUT:
141 return "SDOUT";
142 case WM8994_GP_FN_IRQ:
143 return "IRQ";
144 case WM8994_GP_FN_TEMPERATURE:
145 return "Temperature";
146 case WM8994_GP_FN_MICBIAS1_DET:
147 return "MICBIAS1 detect";
148 case WM8994_GP_FN_MICBIAS1_SHORT:
149 return "MICBIAS1 short";
150 case WM8994_GP_FN_MICBIAS2_DET:
151 return "MICBIAS2 detect";
152 case WM8994_GP_FN_MICBIAS2_SHORT:
153 return "MICBIAS2 short";
154 case WM8994_GP_FN_FLL1_LOCK:
155 return "FLL1 lock";
156 case WM8994_GP_FN_FLL2_LOCK:
157 return "FLL2 lock";
158 case WM8994_GP_FN_SRC1_LOCK:
159 return "SRC1 lock";
160 case WM8994_GP_FN_SRC2_LOCK:
161 return "SRC2 lock";
162 case WM8994_GP_FN_DRC1_ACT:
163 return "DRC1 activity";
164 case WM8994_GP_FN_DRC2_ACT:
165 return "DRC2 activity";
166 case WM8994_GP_FN_DRC3_ACT:
167 return "DRC3 activity";
168 case WM8994_GP_FN_WSEQ_STATUS:
169 return "Write sequencer";
170 case WM8994_GP_FN_FIFO_ERROR:
171 return "FIFO error";
172 case WM8994_GP_FN_OPCLK:
173 return "OPCLK";
174 case WM8994_GP_FN_THW:
175 return "Thermal warning";
176 case WM8994_GP_FN_DCS_DONE:
177 return "DC servo";
178 case WM8994_GP_FN_FLL1_OUT:
179 return "FLL1 output";
180 case WM8994_GP_FN_FLL2_OUT:
181 return "FLL1 output";
182 default:
183 return "Unknown";
184 }
185 }
186
wm8994_gpio_dbg_show(struct seq_file * s,struct gpio_chip * chip)187 static void wm8994_gpio_dbg_show(struct seq_file *s, struct gpio_chip *chip)
188 {
189 struct wm8994_gpio *wm8994_gpio = gpiochip_get_data(chip);
190 struct wm8994 *wm8994 = wm8994_gpio->wm8994;
191 int i;
192
193 for (i = 0; i < chip->ngpio; i++) {
194 int gpio = i + chip->base;
195 int reg;
196 const char *label;
197
198 /* We report the GPIO even if it's not requested since
199 * we're also reporting things like alternate
200 * functions which apply even when the GPIO is not in
201 * use as a GPIO.
202 */
203 label = gpiochip_is_requested(chip, i);
204 if (!label)
205 label = "Unrequested";
206
207 seq_printf(s, " gpio-%-3d (%-20.20s) ", gpio, label);
208
209 reg = wm8994_reg_read(wm8994, WM8994_GPIO_1 + i);
210 if (reg < 0) {
211 dev_err(wm8994->dev,
212 "GPIO control %d read failed: %d\n",
213 gpio, reg);
214 seq_printf(s, "\n");
215 continue;
216 }
217
218 if (reg & WM8994_GPN_DIR)
219 seq_printf(s, "in ");
220 else
221 seq_printf(s, "out ");
222
223 if (reg & WM8994_GPN_PU)
224 seq_printf(s, "pull up ");
225
226 if (reg & WM8994_GPN_PD)
227 seq_printf(s, "pull down ");
228
229 if (reg & WM8994_GPN_POL)
230 seq_printf(s, "inverted ");
231 else
232 seq_printf(s, "noninverted ");
233
234 if (reg & WM8994_GPN_OP_CFG)
235 seq_printf(s, "open drain ");
236 else
237 seq_printf(s, "push-pull ");
238
239 seq_printf(s, "%s (%x)\n",
240 wm8994_gpio_fn(reg & WM8994_GPN_FN_MASK), reg);
241 }
242 }
243 #else
244 #define wm8994_gpio_dbg_show NULL
245 #endif
246
247 static const struct gpio_chip template_chip = {
248 .label = "wm8994",
249 .owner = THIS_MODULE,
250 .request = wm8994_gpio_request,
251 .direction_input = wm8994_gpio_direction_in,
252 .get = wm8994_gpio_get,
253 .direction_output = wm8994_gpio_direction_out,
254 .set = wm8994_gpio_set,
255 .set_config = wm8994_gpio_set_config,
256 .to_irq = wm8994_gpio_to_irq,
257 .dbg_show = wm8994_gpio_dbg_show,
258 .can_sleep = true,
259 };
260
wm8994_gpio_probe(struct platform_device * pdev)261 static int wm8994_gpio_probe(struct platform_device *pdev)
262 {
263 struct wm8994 *wm8994 = dev_get_drvdata(pdev->dev.parent);
264 struct wm8994_pdata *pdata = dev_get_platdata(wm8994->dev);
265 struct wm8994_gpio *wm8994_gpio;
266 int ret;
267
268 wm8994_gpio = devm_kzalloc(&pdev->dev, sizeof(*wm8994_gpio),
269 GFP_KERNEL);
270 if (wm8994_gpio == NULL)
271 return -ENOMEM;
272
273 wm8994_gpio->wm8994 = wm8994;
274 wm8994_gpio->gpio_chip = template_chip;
275 wm8994_gpio->gpio_chip.ngpio = WM8994_GPIO_MAX;
276 wm8994_gpio->gpio_chip.parent = &pdev->dev;
277 if (pdata && pdata->gpio_base)
278 wm8994_gpio->gpio_chip.base = pdata->gpio_base;
279 else
280 wm8994_gpio->gpio_chip.base = -1;
281
282 ret = devm_gpiochip_add_data(&pdev->dev, &wm8994_gpio->gpio_chip,
283 wm8994_gpio);
284 if (ret < 0) {
285 dev_err(&pdev->dev, "Could not register gpiochip, %d\n",
286 ret);
287 return ret;
288 }
289
290 platform_set_drvdata(pdev, wm8994_gpio);
291
292 return ret;
293 }
294
295 static struct platform_driver wm8994_gpio_driver = {
296 .driver.name = "wm8994-gpio",
297 .probe = wm8994_gpio_probe,
298 };
299
wm8994_gpio_init(void)300 static int __init wm8994_gpio_init(void)
301 {
302 return platform_driver_register(&wm8994_gpio_driver);
303 }
304 subsys_initcall(wm8994_gpio_init);
305
wm8994_gpio_exit(void)306 static void __exit wm8994_gpio_exit(void)
307 {
308 platform_driver_unregister(&wm8994_gpio_driver);
309 }
310 module_exit(wm8994_gpio_exit);
311
312 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
313 MODULE_DESCRIPTION("GPIO interface for WM8994");
314 MODULE_LICENSE("GPL");
315 MODULE_ALIAS("platform:wm8994-gpio");
316