Commit | Line | Data |
---|---|---|
966cdc96 MB |
1 | /* |
2 | * Arizona interrupt support | |
3 | * | |
4 | * Copyright 2012 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 | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | */ | |
12 | ||
13 | #include <linux/delay.h> | |
14 | #include <linux/gpio.h> | |
15 | #include <linux/interrupt.h> | |
16 | #include <linux/irq.h> | |
17 | #include <linux/irqdomain.h> | |
18 | #include <linux/module.h> | |
19 | #include <linux/pm_runtime.h> | |
20 | #include <linux/regmap.h> | |
21 | #include <linux/regulator/consumer.h> | |
22 | #include <linux/slab.h> | |
23 | ||
24 | #include <linux/mfd/arizona/core.h> | |
25 | #include <linux/mfd/arizona/registers.h> | |
26 | ||
27 | #include "arizona.h" | |
28 | ||
29 | static int arizona_map_irq(struct arizona *arizona, int irq) | |
30 | { | |
31 | int ret; | |
32 | ||
33 | ret = regmap_irq_get_virq(arizona->aod_irq_chip, irq); | |
34 | if (ret < 0) | |
35 | ret = regmap_irq_get_virq(arizona->irq_chip, irq); | |
36 | ||
37 | return ret; | |
38 | } | |
39 | ||
40 | int arizona_request_irq(struct arizona *arizona, int irq, char *name, | |
41 | irq_handler_t handler, void *data) | |
42 | { | |
43 | irq = arizona_map_irq(arizona, irq); | |
44 | if (irq < 0) | |
45 | return irq; | |
46 | ||
47 | return request_threaded_irq(irq, NULL, handler, IRQF_ONESHOT, | |
48 | name, data); | |
49 | } | |
50 | EXPORT_SYMBOL_GPL(arizona_request_irq); | |
51 | ||
52 | void arizona_free_irq(struct arizona *arizona, int irq, void *data) | |
53 | { | |
54 | irq = arizona_map_irq(arizona, irq); | |
55 | if (irq < 0) | |
56 | return; | |
57 | ||
58 | free_irq(irq, data); | |
59 | } | |
60 | EXPORT_SYMBOL_GPL(arizona_free_irq); | |
61 | ||
62 | int arizona_set_irq_wake(struct arizona *arizona, int irq, int on) | |
63 | { | |
64 | irq = arizona_map_irq(arizona, irq); | |
65 | if (irq < 0) | |
66 | return irq; | |
67 | ||
68 | return irq_set_irq_wake(irq, on); | |
69 | } | |
70 | EXPORT_SYMBOL_GPL(arizona_set_irq_wake); | |
71 | ||
72 | static irqreturn_t arizona_boot_done(int irq, void *data) | |
73 | { | |
74 | struct arizona *arizona = data; | |
75 | ||
76 | dev_dbg(arizona->dev, "Boot done\n"); | |
77 | ||
78 | return IRQ_HANDLED; | |
79 | } | |
80 | ||
81 | static irqreturn_t arizona_ctrlif_err(int irq, void *data) | |
82 | { | |
83 | struct arizona *arizona = data; | |
84 | ||
85 | /* | |
86 | * For pretty much all potential sources a register cache sync | |
87 | * won't help, we've just got a software bug somewhere. | |
88 | */ | |
89 | dev_err(arizona->dev, "Control interface error\n"); | |
90 | ||
91 | return IRQ_HANDLED; | |
92 | } | |
93 | ||
94 | static irqreturn_t arizona_irq_thread(int irq, void *data) | |
95 | { | |
96 | struct arizona *arizona = data; | |
3092f805 | 97 | bool poll; |
3080de4e | 98 | unsigned int val; |
cdabc1c8 | 99 | int ret; |
966cdc96 MB |
100 | |
101 | ret = pm_runtime_get_sync(arizona->dev); | |
102 | if (ret < 0) { | |
103 | dev_err(arizona->dev, "Failed to resume device: %d\n", ret); | |
104 | return IRQ_NONE; | |
105 | } | |
106 | ||
3092f805 MB |
107 | do { |
108 | poll = false; | |
109 | ||
110 | /* Always handle the AoD domain */ | |
111 | handle_nested_irq(irq_find_mapping(arizona->virq, 0)); | |
112 | ||
113 | /* | |
114 | * Check if one of the main interrupts is asserted and only | |
115 | * check that domain if it is. | |
116 | */ | |
117 | ret = regmap_read(arizona->regmap, ARIZONA_IRQ_PIN_STATUS, | |
118 | &val); | |
119 | if (ret == 0 && val & ARIZONA_IRQ1_STS) { | |
120 | handle_nested_irq(irq_find_mapping(arizona->virq, 1)); | |
121 | } else if (ret != 0) { | |
122 | dev_err(arizona->dev, | |
123 | "Failed to read main IRQ status: %d\n", ret); | |
124 | } | |
3080de4e | 125 | |
3092f805 MB |
126 | /* |
127 | * Poll the IRQ pin status to see if we're really done | |
128 | * if the interrupt controller can't do it for us. | |
129 | */ | |
130 | if (!arizona->pdata.irq_gpio) { | |
131 | break; | |
132 | } else if (arizona->pdata.irq_flags & IRQF_TRIGGER_RISING && | |
133 | gpio_get_value_cansleep(arizona->pdata.irq_gpio)) { | |
134 | poll = true; | |
135 | } else if (arizona->pdata.irq_flags & IRQF_TRIGGER_FALLING && | |
136 | !gpio_get_value_cansleep(arizona->pdata.irq_gpio)) { | |
137 | poll = true; | |
138 | } | |
139 | } while (poll); | |
966cdc96 MB |
140 | |
141 | pm_runtime_mark_last_busy(arizona->dev); | |
142 | pm_runtime_put_autosuspend(arizona->dev); | |
143 | ||
144 | return IRQ_HANDLED; | |
145 | } | |
146 | ||
147 | static void arizona_irq_enable(struct irq_data *data) | |
148 | { | |
149 | } | |
150 | ||
151 | static void arizona_irq_disable(struct irq_data *data) | |
152 | { | |
153 | } | |
154 | ||
c38715fe CK |
155 | static int arizona_irq_set_wake(struct irq_data *data, unsigned int on) |
156 | { | |
157 | struct arizona *arizona = irq_data_get_irq_chip_data(data); | |
158 | ||
159 | return irq_set_irq_wake(arizona->irq, on); | |
160 | } | |
161 | ||
966cdc96 MB |
162 | static struct irq_chip arizona_irq_chip = { |
163 | .name = "arizona", | |
164 | .irq_disable = arizona_irq_disable, | |
165 | .irq_enable = arizona_irq_enable, | |
c38715fe | 166 | .irq_set_wake = arizona_irq_set_wake, |
966cdc96 MB |
167 | }; |
168 | ||
169 | static int arizona_irq_map(struct irq_domain *h, unsigned int virq, | |
170 | irq_hw_number_t hw) | |
171 | { | |
172 | struct regmap_irq_chip_data *data = h->host_data; | |
173 | ||
174 | irq_set_chip_data(virq, data); | |
cfeb35da | 175 | irq_set_chip_and_handler(virq, &arizona_irq_chip, handle_simple_irq); |
966cdc96 | 176 | irq_set_nested_thread(virq, 1); |
966cdc96 | 177 | irq_set_noprobe(virq); |
966cdc96 MB |
178 | |
179 | return 0; | |
180 | } | |
181 | ||
7ce7b26f | 182 | static const struct irq_domain_ops arizona_domain_ops = { |
966cdc96 MB |
183 | .map = arizona_irq_map, |
184 | .xlate = irq_domain_xlate_twocell, | |
185 | }; | |
186 | ||
187 | int arizona_irq_init(struct arizona *arizona) | |
188 | { | |
189 | int flags = IRQF_ONESHOT; | |
190 | int ret, i; | |
191 | const struct regmap_irq_chip *aod, *irq; | |
22c75fe7 | 192 | struct irq_data *irq_data; |
966cdc96 | 193 | |
30a2af3a CK |
194 | arizona->ctrlif_error = true; |
195 | ||
966cdc96 | 196 | switch (arizona->type) { |
863df8d5 | 197 | #ifdef CONFIG_MFD_WM5102 |
966cdc96 MB |
198 | case WM5102: |
199 | aod = &wm5102_aod; | |
200 | irq = &wm5102_irq; | |
92d80139 | 201 | |
30a2af3a | 202 | arizona->ctrlif_error = false; |
966cdc96 | 203 | break; |
e102befe MB |
204 | #endif |
205 | #ifdef CONFIG_MFD_WM5110 | |
206 | case WM5110: | |
e5d4ef0d | 207 | case WM8280: |
e102befe | 208 | aod = &wm5110_aod; |
3215501f CK |
209 | |
210 | switch (arizona->rev) { | |
211 | case 0 ... 2: | |
212 | irq = &wm5110_irq; | |
213 | break; | |
214 | default: | |
215 | irq = &wm5110_revd_irq; | |
216 | break; | |
217 | } | |
92d80139 | 218 | |
30a2af3a | 219 | arizona->ctrlif_error = false; |
e102befe | 220 | break; |
863df8d5 | 221 | #endif |
dc7d4863 CK |
222 | #ifdef CONFIG_MFD_WM8997 |
223 | case WM8997: | |
224 | aod = &wm8997_aod; | |
225 | irq = &wm8997_irq; | |
226 | ||
30a2af3a | 227 | arizona->ctrlif_error = false; |
dc7d4863 CK |
228 | break; |
229 | #endif | |
6887b042 RF |
230 | #ifdef CONFIG_MFD_WM8998 |
231 | case WM8998: | |
232 | case WM1814: | |
233 | aod = &wm8998_aod; | |
234 | irq = &wm8998_irq; | |
235 | ||
236 | arizona->ctrlif_error = false; | |
237 | break; | |
238 | #endif | |
966cdc96 MB |
239 | default: |
240 | BUG_ON("Unknown Arizona class device" == NULL); | |
241 | return -EINVAL; | |
242 | } | |
243 | ||
1816cb34 MB |
244 | /* Disable all wake sources by default */ |
245 | regmap_write(arizona->regmap, ARIZONA_WAKE_CONTROL, 0); | |
246 | ||
22c75fe7 MB |
247 | /* Read the flags from the interrupt controller if not specified */ |
248 | if (!arizona->pdata.irq_flags) { | |
249 | irq_data = irq_get_irq_data(arizona->irq); | |
250 | if (!irq_data) { | |
251 | dev_err(arizona->dev, "Invalid IRQ: %d\n", | |
252 | arizona->irq); | |
253 | return -EINVAL; | |
254 | } | |
255 | ||
256 | arizona->pdata.irq_flags = irqd_get_trigger_type(irq_data); | |
257 | switch (arizona->pdata.irq_flags) { | |
258 | case IRQF_TRIGGER_LOW: | |
259 | case IRQF_TRIGGER_HIGH: | |
260 | case IRQF_TRIGGER_RISING: | |
261 | case IRQF_TRIGGER_FALLING: | |
262 | break; | |
263 | ||
264 | case IRQ_TYPE_NONE: | |
265 | default: | |
266 | /* Device default */ | |
267 | arizona->pdata.irq_flags = IRQF_TRIGGER_LOW; | |
268 | break; | |
269 | } | |
270 | } | |
f8a0941f MB |
271 | |
272 | if (arizona->pdata.irq_flags & (IRQF_TRIGGER_HIGH | | |
273 | IRQF_TRIGGER_RISING)) { | |
966cdc96 MB |
274 | ret = regmap_update_bits(arizona->regmap, ARIZONA_IRQ_CTRL_1, |
275 | ARIZONA_IRQ_POL, 0); | |
276 | if (ret != 0) { | |
277 | dev_err(arizona->dev, "Couldn't set IRQ polarity: %d\n", | |
278 | ret); | |
279 | goto err; | |
280 | } | |
966cdc96 MB |
281 | } |
282 | ||
f8a0941f MB |
283 | flags |= arizona->pdata.irq_flags; |
284 | ||
966cdc96 MB |
285 | /* Allocate a virtual IRQ domain to distribute to the regmap domains */ |
286 | arizona->virq = irq_domain_add_linear(NULL, 2, &arizona_domain_ops, | |
287 | arizona); | |
288 | if (!arizona->virq) { | |
b7dea5dc | 289 | dev_err(arizona->dev, "Failed to add core IRQ domain\n"); |
966cdc96 MB |
290 | ret = -EINVAL; |
291 | goto err; | |
292 | } | |
293 | ||
294 | ret = regmap_add_irq_chip(arizona->regmap, | |
295 | irq_create_mapping(arizona->virq, 0), | |
2a3377ee | 296 | IRQF_ONESHOT, 0, aod, |
966cdc96 MB |
297 | &arizona->aod_irq_chip); |
298 | if (ret != 0) { | |
299 | dev_err(arizona->dev, "Failed to add AOD IRQs: %d\n", ret); | |
300 | goto err_domain; | |
301 | } | |
302 | ||
303 | ret = regmap_add_irq_chip(arizona->regmap, | |
304 | irq_create_mapping(arizona->virq, 1), | |
2a3377ee | 305 | IRQF_ONESHOT, 0, irq, |
966cdc96 MB |
306 | &arizona->irq_chip); |
307 | if (ret != 0) { | |
d1cb4cc9 | 308 | dev_err(arizona->dev, "Failed to add main IRQs: %d\n", ret); |
966cdc96 MB |
309 | goto err_aod; |
310 | } | |
311 | ||
312 | /* Make sure the boot done IRQ is unmasked for resumes */ | |
313 | i = arizona_map_irq(arizona, ARIZONA_IRQ_BOOT_DONE); | |
314 | ret = request_threaded_irq(i, NULL, arizona_boot_done, IRQF_ONESHOT, | |
315 | "Boot done", arizona); | |
316 | if (ret != 0) { | |
317 | dev_err(arizona->dev, "Failed to request boot done %d: %d\n", | |
318 | arizona->irq, ret); | |
319 | goto err_boot_done; | |
320 | } | |
321 | ||
322 | /* Handle control interface errors in the core */ | |
30a2af3a | 323 | if (arizona->ctrlif_error) { |
92d80139 MB |
324 | i = arizona_map_irq(arizona, ARIZONA_IRQ_CTRLIF_ERR); |
325 | ret = request_threaded_irq(i, NULL, arizona_ctrlif_err, | |
326 | IRQF_ONESHOT, | |
327 | "Control interface error", arizona); | |
328 | if (ret != 0) { | |
329 | dev_err(arizona->dev, | |
330 | "Failed to request CTRLIF_ERR %d: %d\n", | |
331 | arizona->irq, ret); | |
332 | goto err_ctrlif; | |
333 | } | |
966cdc96 MB |
334 | } |
335 | ||
3092f805 MB |
336 | /* Used to emulate edge trigger and to work around broken pinmux */ |
337 | if (arizona->pdata.irq_gpio) { | |
338 | if (gpio_to_irq(arizona->pdata.irq_gpio) != arizona->irq) { | |
339 | dev_warn(arizona->dev, "IRQ %d is not GPIO %d (%d)\n", | |
340 | arizona->irq, arizona->pdata.irq_gpio, | |
341 | gpio_to_irq(arizona->pdata.irq_gpio)); | |
342 | arizona->irq = gpio_to_irq(arizona->pdata.irq_gpio); | |
343 | } | |
344 | ||
345 | ret = devm_gpio_request_one(arizona->dev, | |
346 | arizona->pdata.irq_gpio, | |
347 | GPIOF_IN, "arizona IRQ"); | |
348 | if (ret != 0) { | |
349 | dev_err(arizona->dev, | |
350 | "Failed to request IRQ GPIO %d:: %d\n", | |
351 | arizona->pdata.irq_gpio, ret); | |
352 | arizona->pdata.irq_gpio = 0; | |
353 | } | |
354 | } | |
355 | ||
966cdc96 MB |
356 | ret = request_threaded_irq(arizona->irq, NULL, arizona_irq_thread, |
357 | flags, "arizona", arizona); | |
358 | ||
359 | if (ret != 0) { | |
7994c664 | 360 | dev_err(arizona->dev, "Failed to request primary IRQ %d: %d\n", |
966cdc96 MB |
361 | arizona->irq, ret); |
362 | goto err_main_irq; | |
363 | } | |
364 | ||
365 | return 0; | |
366 | ||
367 | err_main_irq: | |
30a2af3a CK |
368 | if (arizona->ctrlif_error) |
369 | free_irq(arizona_map_irq(arizona, ARIZONA_IRQ_CTRLIF_ERR), | |
370 | arizona); | |
966cdc96 MB |
371 | err_ctrlif: |
372 | free_irq(arizona_map_irq(arizona, ARIZONA_IRQ_BOOT_DONE), arizona); | |
373 | err_boot_done: | |
374 | regmap_del_irq_chip(irq_create_mapping(arizona->virq, 1), | |
375 | arizona->irq_chip); | |
376 | err_aod: | |
377 | regmap_del_irq_chip(irq_create_mapping(arizona->virq, 0), | |
378 | arizona->aod_irq_chip); | |
379 | err_domain: | |
380 | err: | |
381 | return ret; | |
382 | } | |
383 | ||
384 | int arizona_irq_exit(struct arizona *arizona) | |
385 | { | |
30a2af3a CK |
386 | if (arizona->ctrlif_error) |
387 | free_irq(arizona_map_irq(arizona, ARIZONA_IRQ_CTRLIF_ERR), | |
388 | arizona); | |
966cdc96 MB |
389 | free_irq(arizona_map_irq(arizona, ARIZONA_IRQ_BOOT_DONE), arizona); |
390 | regmap_del_irq_chip(irq_create_mapping(arizona->virq, 1), | |
391 | arizona->irq_chip); | |
392 | regmap_del_irq_chip(irq_create_mapping(arizona->virq, 0), | |
393 | arizona->aod_irq_chip); | |
394 | free_irq(arizona->irq, arizona); | |
395 | ||
396 | return 0; | |
397 | } |