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