blob: a8322a4e18d363f53260e744e4f842da8ebae3e7 [file] [log] [blame]
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001// SPDX-License-Identifier: GPL-2.0
2/*
3 * Copyright (C) Maxime Coquelin 2015
4 * Copyright (C) STMicroelectronics 2017
5 * Author: Maxime Coquelin <mcoquelin.stm32@gmail.com>
6 */
7
8#include <linux/bitops.h>
David Brazdil0f672f62019-12-10 10:32:29 +00009#include <linux/delay.h>
10#include <linux/hwspinlock.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000011#include <linux/interrupt.h>
12#include <linux/io.h>
13#include <linux/irq.h>
14#include <linux/irqchip.h>
15#include <linux/irqchip/chained_irq.h>
16#include <linux/irqdomain.h>
David Brazdil0f672f62019-12-10 10:32:29 +000017#include <linux/module.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000018#include <linux/of_address.h>
19#include <linux/of_irq.h>
David Brazdil0f672f62019-12-10 10:32:29 +000020#include <linux/of_platform.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000021#include <linux/syscore_ops.h>
22
23#include <dt-bindings/interrupt-controller/arm-gic.h>
24
25#define IRQS_PER_BANK 32
26
David Brazdil0f672f62019-12-10 10:32:29 +000027#define HWSPNLCK_TIMEOUT 1000 /* usec */
28#define HWSPNLCK_RETRY_DELAY 100 /* usec */
29
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000030struct stm32_exti_bank {
31 u32 imr_ofst;
32 u32 emr_ofst;
33 u32 rtsr_ofst;
34 u32 ftsr_ofst;
35 u32 swier_ofst;
36 u32 rpr_ofst;
37 u32 fpr_ofst;
38};
39
40#define UNDEF_REG ~0
41
42struct stm32_desc_irq {
43 u32 exti;
44 u32 irq_parent;
45};
46
47struct stm32_exti_drv_data {
48 const struct stm32_exti_bank **exti_banks;
49 const struct stm32_desc_irq *desc_irqs;
50 u32 bank_nr;
51 u32 irq_nr;
52};
53
54struct stm32_exti_chip_data {
55 struct stm32_exti_host_data *host_data;
56 const struct stm32_exti_bank *reg_bank;
57 struct raw_spinlock rlock;
58 u32 wake_active;
59 u32 mask_cache;
60 u32 rtsr_cache;
61 u32 ftsr_cache;
62};
63
64struct stm32_exti_host_data {
65 void __iomem *base;
66 struct stm32_exti_chip_data *chips_data;
67 const struct stm32_exti_drv_data *drv_data;
David Brazdil0f672f62019-12-10 10:32:29 +000068 struct hwspinlock *hwlock;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000069};
70
71static struct stm32_exti_host_data *stm32_host_data;
72
73static const struct stm32_exti_bank stm32f4xx_exti_b1 = {
74 .imr_ofst = 0x00,
75 .emr_ofst = 0x04,
76 .rtsr_ofst = 0x08,
77 .ftsr_ofst = 0x0C,
78 .swier_ofst = 0x10,
79 .rpr_ofst = 0x14,
80 .fpr_ofst = UNDEF_REG,
81};
82
83static const struct stm32_exti_bank *stm32f4xx_exti_banks[] = {
84 &stm32f4xx_exti_b1,
85};
86
87static const struct stm32_exti_drv_data stm32f4xx_drv_data = {
88 .exti_banks = stm32f4xx_exti_banks,
89 .bank_nr = ARRAY_SIZE(stm32f4xx_exti_banks),
90};
91
92static const struct stm32_exti_bank stm32h7xx_exti_b1 = {
93 .imr_ofst = 0x80,
94 .emr_ofst = 0x84,
95 .rtsr_ofst = 0x00,
96 .ftsr_ofst = 0x04,
97 .swier_ofst = 0x08,
98 .rpr_ofst = 0x88,
99 .fpr_ofst = UNDEF_REG,
100};
101
102static const struct stm32_exti_bank stm32h7xx_exti_b2 = {
103 .imr_ofst = 0x90,
104 .emr_ofst = 0x94,
105 .rtsr_ofst = 0x20,
106 .ftsr_ofst = 0x24,
107 .swier_ofst = 0x28,
108 .rpr_ofst = 0x98,
109 .fpr_ofst = UNDEF_REG,
110};
111
112static const struct stm32_exti_bank stm32h7xx_exti_b3 = {
113 .imr_ofst = 0xA0,
114 .emr_ofst = 0xA4,
115 .rtsr_ofst = 0x40,
116 .ftsr_ofst = 0x44,
117 .swier_ofst = 0x48,
118 .rpr_ofst = 0xA8,
119 .fpr_ofst = UNDEF_REG,
120};
121
122static const struct stm32_exti_bank *stm32h7xx_exti_banks[] = {
123 &stm32h7xx_exti_b1,
124 &stm32h7xx_exti_b2,
125 &stm32h7xx_exti_b3,
126};
127
128static const struct stm32_exti_drv_data stm32h7xx_drv_data = {
129 .exti_banks = stm32h7xx_exti_banks,
130 .bank_nr = ARRAY_SIZE(stm32h7xx_exti_banks),
131};
132
133static const struct stm32_exti_bank stm32mp1_exti_b1 = {
134 .imr_ofst = 0x80,
135 .emr_ofst = 0x84,
136 .rtsr_ofst = 0x00,
137 .ftsr_ofst = 0x04,
138 .swier_ofst = 0x08,
139 .rpr_ofst = 0x0C,
140 .fpr_ofst = 0x10,
141};
142
143static const struct stm32_exti_bank stm32mp1_exti_b2 = {
144 .imr_ofst = 0x90,
145 .emr_ofst = 0x94,
146 .rtsr_ofst = 0x20,
147 .ftsr_ofst = 0x24,
148 .swier_ofst = 0x28,
149 .rpr_ofst = 0x2C,
150 .fpr_ofst = 0x30,
151};
152
153static const struct stm32_exti_bank stm32mp1_exti_b3 = {
154 .imr_ofst = 0xA0,
155 .emr_ofst = 0xA4,
156 .rtsr_ofst = 0x40,
157 .ftsr_ofst = 0x44,
158 .swier_ofst = 0x48,
159 .rpr_ofst = 0x4C,
160 .fpr_ofst = 0x50,
161};
162
163static const struct stm32_exti_bank *stm32mp1_exti_banks[] = {
164 &stm32mp1_exti_b1,
165 &stm32mp1_exti_b2,
166 &stm32mp1_exti_b3,
167};
168
169static const struct stm32_desc_irq stm32mp1_desc_irq[] = {
170 { .exti = 0, .irq_parent = 6 },
171 { .exti = 1, .irq_parent = 7 },
172 { .exti = 2, .irq_parent = 8 },
173 { .exti = 3, .irq_parent = 9 },
174 { .exti = 4, .irq_parent = 10 },
175 { .exti = 5, .irq_parent = 23 },
176 { .exti = 6, .irq_parent = 64 },
177 { .exti = 7, .irq_parent = 65 },
178 { .exti = 8, .irq_parent = 66 },
179 { .exti = 9, .irq_parent = 67 },
180 { .exti = 10, .irq_parent = 40 },
181 { .exti = 11, .irq_parent = 42 },
182 { .exti = 12, .irq_parent = 76 },
183 { .exti = 13, .irq_parent = 77 },
184 { .exti = 14, .irq_parent = 121 },
185 { .exti = 15, .irq_parent = 127 },
186 { .exti = 16, .irq_parent = 1 },
187 { .exti = 65, .irq_parent = 144 },
188 { .exti = 68, .irq_parent = 143 },
189 { .exti = 73, .irq_parent = 129 },
190};
191
192static const struct stm32_exti_drv_data stm32mp1_drv_data = {
193 .exti_banks = stm32mp1_exti_banks,
194 .bank_nr = ARRAY_SIZE(stm32mp1_exti_banks),
195 .desc_irqs = stm32mp1_desc_irq,
196 .irq_nr = ARRAY_SIZE(stm32mp1_desc_irq),
197};
198
199static int stm32_exti_to_irq(const struct stm32_exti_drv_data *drv_data,
200 irq_hw_number_t hwirq)
201{
202 const struct stm32_desc_irq *desc_irq;
203 int i;
204
205 if (!drv_data->desc_irqs)
206 return -EINVAL;
207
208 for (i = 0; i < drv_data->irq_nr; i++) {
209 desc_irq = &drv_data->desc_irqs[i];
210 if (desc_irq->exti == hwirq)
211 return desc_irq->irq_parent;
212 }
213
214 return -EINVAL;
215}
216
217static unsigned long stm32_exti_pending(struct irq_chip_generic *gc)
218{
219 struct stm32_exti_chip_data *chip_data = gc->private;
220 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
221 unsigned long pending;
222
223 pending = irq_reg_readl(gc, stm32_bank->rpr_ofst);
224 if (stm32_bank->fpr_ofst != UNDEF_REG)
225 pending |= irq_reg_readl(gc, stm32_bank->fpr_ofst);
226
227 return pending;
228}
229
230static void stm32_irq_handler(struct irq_desc *desc)
231{
232 struct irq_domain *domain = irq_desc_get_handler_data(desc);
233 struct irq_chip *chip = irq_desc_get_chip(desc);
234 unsigned int virq, nbanks = domain->gc->num_chips;
235 struct irq_chip_generic *gc;
236 unsigned long pending;
237 int n, i, irq_base = 0;
238
239 chained_irq_enter(chip, desc);
240
241 for (i = 0; i < nbanks; i++, irq_base += IRQS_PER_BANK) {
242 gc = irq_get_domain_generic_chip(domain, irq_base);
243
244 while ((pending = stm32_exti_pending(gc))) {
245 for_each_set_bit(n, &pending, IRQS_PER_BANK) {
246 virq = irq_find_mapping(domain, irq_base + n);
247 generic_handle_irq(virq);
248 }
249 }
250 }
251
252 chained_irq_exit(chip, desc);
253}
254
255static int stm32_exti_set_type(struct irq_data *d,
256 unsigned int type, u32 *rtsr, u32 *ftsr)
257{
258 u32 mask = BIT(d->hwirq % IRQS_PER_BANK);
259
260 switch (type) {
261 case IRQ_TYPE_EDGE_RISING:
262 *rtsr |= mask;
263 *ftsr &= ~mask;
264 break;
265 case IRQ_TYPE_EDGE_FALLING:
266 *rtsr &= ~mask;
267 *ftsr |= mask;
268 break;
269 case IRQ_TYPE_EDGE_BOTH:
270 *rtsr |= mask;
271 *ftsr |= mask;
272 break;
273 default:
274 return -EINVAL;
275 }
276
277 return 0;
278}
279
David Brazdil0f672f62019-12-10 10:32:29 +0000280static int stm32_exti_hwspin_lock(struct stm32_exti_chip_data *chip_data)
281{
282 int ret, timeout = 0;
283
284 if (!chip_data->host_data->hwlock)
285 return 0;
286
287 /*
288 * Use the x_raw API since we are under spin_lock protection.
289 * Do not use the x_timeout API because we are under irq_disable
290 * mode (see __setup_irq())
291 */
292 do {
293 ret = hwspin_trylock_raw(chip_data->host_data->hwlock);
294 if (!ret)
295 return 0;
296
297 udelay(HWSPNLCK_RETRY_DELAY);
298 timeout += HWSPNLCK_RETRY_DELAY;
299 } while (timeout < HWSPNLCK_TIMEOUT);
300
301 if (ret == -EBUSY)
302 ret = -ETIMEDOUT;
303
304 if (ret)
305 pr_err("%s can't get hwspinlock (%d)\n", __func__, ret);
306
307 return ret;
308}
309
310static void stm32_exti_hwspin_unlock(struct stm32_exti_chip_data *chip_data)
311{
312 if (chip_data->host_data->hwlock)
313 hwspin_unlock_raw(chip_data->host_data->hwlock);
314}
315
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000316static int stm32_irq_set_type(struct irq_data *d, unsigned int type)
317{
318 struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
319 struct stm32_exti_chip_data *chip_data = gc->private;
320 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
321 u32 rtsr, ftsr;
322 int err;
323
324 irq_gc_lock(gc);
325
David Brazdil0f672f62019-12-10 10:32:29 +0000326 err = stm32_exti_hwspin_lock(chip_data);
327 if (err)
328 goto unlock;
329
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000330 rtsr = irq_reg_readl(gc, stm32_bank->rtsr_ofst);
331 ftsr = irq_reg_readl(gc, stm32_bank->ftsr_ofst);
332
333 err = stm32_exti_set_type(d, type, &rtsr, &ftsr);
David Brazdil0f672f62019-12-10 10:32:29 +0000334 if (err)
335 goto unspinlock;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000336
337 irq_reg_writel(gc, rtsr, stm32_bank->rtsr_ofst);
338 irq_reg_writel(gc, ftsr, stm32_bank->ftsr_ofst);
339
David Brazdil0f672f62019-12-10 10:32:29 +0000340unspinlock:
341 stm32_exti_hwspin_unlock(chip_data);
342unlock:
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000343 irq_gc_unlock(gc);
344
David Brazdil0f672f62019-12-10 10:32:29 +0000345 return err;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000346}
347
348static void stm32_chip_suspend(struct stm32_exti_chip_data *chip_data,
349 u32 wake_active)
350{
351 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
352 void __iomem *base = chip_data->host_data->base;
353
354 /* save rtsr, ftsr registers */
355 chip_data->rtsr_cache = readl_relaxed(base + stm32_bank->rtsr_ofst);
356 chip_data->ftsr_cache = readl_relaxed(base + stm32_bank->ftsr_ofst);
357
358 writel_relaxed(wake_active, base + stm32_bank->imr_ofst);
359}
360
361static void stm32_chip_resume(struct stm32_exti_chip_data *chip_data,
362 u32 mask_cache)
363{
364 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
365 void __iomem *base = chip_data->host_data->base;
366
367 /* restore rtsr, ftsr, registers */
368 writel_relaxed(chip_data->rtsr_cache, base + stm32_bank->rtsr_ofst);
369 writel_relaxed(chip_data->ftsr_cache, base + stm32_bank->ftsr_ofst);
370
371 writel_relaxed(mask_cache, base + stm32_bank->imr_ofst);
372}
373
374static void stm32_irq_suspend(struct irq_chip_generic *gc)
375{
376 struct stm32_exti_chip_data *chip_data = gc->private;
377
378 irq_gc_lock(gc);
379 stm32_chip_suspend(chip_data, gc->wake_active);
380 irq_gc_unlock(gc);
381}
382
383static void stm32_irq_resume(struct irq_chip_generic *gc)
384{
385 struct stm32_exti_chip_data *chip_data = gc->private;
386
387 irq_gc_lock(gc);
388 stm32_chip_resume(chip_data, gc->mask_cache);
389 irq_gc_unlock(gc);
390}
391
392static int stm32_exti_alloc(struct irq_domain *d, unsigned int virq,
393 unsigned int nr_irqs, void *data)
394{
395 struct irq_fwspec *fwspec = data;
396 irq_hw_number_t hwirq;
397
398 hwirq = fwspec->param[0];
399
400 irq_map_generic_chip(d, virq, hwirq);
401
402 return 0;
403}
404
405static void stm32_exti_free(struct irq_domain *d, unsigned int virq,
406 unsigned int nr_irqs)
407{
408 struct irq_data *data = irq_domain_get_irq_data(d, virq);
409
410 irq_domain_reset_irq_data(data);
411}
412
413static const struct irq_domain_ops irq_exti_domain_ops = {
414 .map = irq_map_generic_chip,
415 .alloc = stm32_exti_alloc,
416 .free = stm32_exti_free,
417};
418
419static void stm32_irq_ack(struct irq_data *d)
420{
421 struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d);
422 struct stm32_exti_chip_data *chip_data = gc->private;
423 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
424
425 irq_gc_lock(gc);
426
427 irq_reg_writel(gc, d->mask, stm32_bank->rpr_ofst);
428 if (stm32_bank->fpr_ofst != UNDEF_REG)
429 irq_reg_writel(gc, d->mask, stm32_bank->fpr_ofst);
430
431 irq_gc_unlock(gc);
432}
433
Olivier Deprez0e641232021-09-23 10:07:05 +0200434/* directly set the target bit without reading first. */
435static inline void stm32_exti_write_bit(struct irq_data *d, u32 reg)
436{
437 struct stm32_exti_chip_data *chip_data = irq_data_get_irq_chip_data(d);
438 void __iomem *base = chip_data->host_data->base;
439 u32 val = BIT(d->hwirq % IRQS_PER_BANK);
440
441 writel_relaxed(val, base + reg);
442}
443
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000444static inline u32 stm32_exti_set_bit(struct irq_data *d, u32 reg)
445{
446 struct stm32_exti_chip_data *chip_data = irq_data_get_irq_chip_data(d);
447 void __iomem *base = chip_data->host_data->base;
448 u32 val;
449
450 val = readl_relaxed(base + reg);
451 val |= BIT(d->hwirq % IRQS_PER_BANK);
452 writel_relaxed(val, base + reg);
453
454 return val;
455}
456
457static inline u32 stm32_exti_clr_bit(struct irq_data *d, u32 reg)
458{
459 struct stm32_exti_chip_data *chip_data = irq_data_get_irq_chip_data(d);
460 void __iomem *base = chip_data->host_data->base;
461 u32 val;
462
463 val = readl_relaxed(base + reg);
464 val &= ~BIT(d->hwirq % IRQS_PER_BANK);
465 writel_relaxed(val, base + reg);
466
467 return val;
468}
469
470static void stm32_exti_h_eoi(struct irq_data *d)
471{
472 struct stm32_exti_chip_data *chip_data = irq_data_get_irq_chip_data(d);
473 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
474
475 raw_spin_lock(&chip_data->rlock);
476
Olivier Deprez0e641232021-09-23 10:07:05 +0200477 stm32_exti_write_bit(d, stm32_bank->rpr_ofst);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000478 if (stm32_bank->fpr_ofst != UNDEF_REG)
Olivier Deprez0e641232021-09-23 10:07:05 +0200479 stm32_exti_write_bit(d, stm32_bank->fpr_ofst);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000480
481 raw_spin_unlock(&chip_data->rlock);
482
483 if (d->parent_data->chip)
484 irq_chip_eoi_parent(d);
485}
486
487static void stm32_exti_h_mask(struct irq_data *d)
488{
489 struct stm32_exti_chip_data *chip_data = irq_data_get_irq_chip_data(d);
490 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
491
492 raw_spin_lock(&chip_data->rlock);
493 chip_data->mask_cache = stm32_exti_clr_bit(d, stm32_bank->imr_ofst);
494 raw_spin_unlock(&chip_data->rlock);
495
496 if (d->parent_data->chip)
497 irq_chip_mask_parent(d);
498}
499
500static void stm32_exti_h_unmask(struct irq_data *d)
501{
502 struct stm32_exti_chip_data *chip_data = irq_data_get_irq_chip_data(d);
503 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
504
505 raw_spin_lock(&chip_data->rlock);
506 chip_data->mask_cache = stm32_exti_set_bit(d, stm32_bank->imr_ofst);
507 raw_spin_unlock(&chip_data->rlock);
508
509 if (d->parent_data->chip)
510 irq_chip_unmask_parent(d);
511}
512
513static int stm32_exti_h_set_type(struct irq_data *d, unsigned int type)
514{
515 struct stm32_exti_chip_data *chip_data = irq_data_get_irq_chip_data(d);
516 const struct stm32_exti_bank *stm32_bank = chip_data->reg_bank;
517 void __iomem *base = chip_data->host_data->base;
518 u32 rtsr, ftsr;
519 int err;
520
521 raw_spin_lock(&chip_data->rlock);
David Brazdil0f672f62019-12-10 10:32:29 +0000522
523 err = stm32_exti_hwspin_lock(chip_data);
524 if (err)
525 goto unlock;
526
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000527 rtsr = readl_relaxed(base + stm32_bank->rtsr_ofst);
528 ftsr = readl_relaxed(base + stm32_bank->ftsr_ofst);
529
530 err = stm32_exti_set_type(d, type, &rtsr, &ftsr);
David Brazdil0f672f62019-12-10 10:32:29 +0000531 if (err)
532 goto unspinlock;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000533
534 writel_relaxed(rtsr, base + stm32_bank->rtsr_ofst);
535 writel_relaxed(ftsr, base + stm32_bank->ftsr_ofst);
David Brazdil0f672f62019-12-10 10:32:29 +0000536
537unspinlock:
538 stm32_exti_hwspin_unlock(chip_data);
539unlock:
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000540 raw_spin_unlock(&chip_data->rlock);
541
David Brazdil0f672f62019-12-10 10:32:29 +0000542 return err;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000543}
544
545static int stm32_exti_h_set_wake(struct irq_data *d, unsigned int on)
546{
547 struct stm32_exti_chip_data *chip_data = irq_data_get_irq_chip_data(d);
548 u32 mask = BIT(d->hwirq % IRQS_PER_BANK);
549
550 raw_spin_lock(&chip_data->rlock);
551
552 if (on)
553 chip_data->wake_active |= mask;
554 else
555 chip_data->wake_active &= ~mask;
556
557 raw_spin_unlock(&chip_data->rlock);
558
559 return 0;
560}
561
562static int stm32_exti_h_set_affinity(struct irq_data *d,
563 const struct cpumask *dest, bool force)
564{
565 if (d->parent_data->chip)
566 return irq_chip_set_affinity_parent(d, dest, force);
567
568 return -EINVAL;
569}
570
David Brazdil0f672f62019-12-10 10:32:29 +0000571static int __maybe_unused stm32_exti_h_suspend(void)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000572{
573 struct stm32_exti_chip_data *chip_data;
574 int i;
575
576 for (i = 0; i < stm32_host_data->drv_data->bank_nr; i++) {
577 chip_data = &stm32_host_data->chips_data[i];
578 raw_spin_lock(&chip_data->rlock);
579 stm32_chip_suspend(chip_data, chip_data->wake_active);
580 raw_spin_unlock(&chip_data->rlock);
581 }
582
583 return 0;
584}
585
David Brazdil0f672f62019-12-10 10:32:29 +0000586static void __maybe_unused stm32_exti_h_resume(void)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000587{
588 struct stm32_exti_chip_data *chip_data;
589 int i;
590
591 for (i = 0; i < stm32_host_data->drv_data->bank_nr; i++) {
592 chip_data = &stm32_host_data->chips_data[i];
593 raw_spin_lock(&chip_data->rlock);
594 stm32_chip_resume(chip_data, chip_data->mask_cache);
595 raw_spin_unlock(&chip_data->rlock);
596 }
597}
598
599static struct syscore_ops stm32_exti_h_syscore_ops = {
David Brazdil0f672f62019-12-10 10:32:29 +0000600#ifdef CONFIG_PM_SLEEP
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000601 .suspend = stm32_exti_h_suspend,
602 .resume = stm32_exti_h_resume,
David Brazdil0f672f62019-12-10 10:32:29 +0000603#endif
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000604};
605
David Brazdil0f672f62019-12-10 10:32:29 +0000606static void stm32_exti_h_syscore_init(struct stm32_exti_host_data *host_data)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000607{
David Brazdil0f672f62019-12-10 10:32:29 +0000608 stm32_host_data = host_data;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000609 register_syscore_ops(&stm32_exti_h_syscore_ops);
610}
David Brazdil0f672f62019-12-10 10:32:29 +0000611
612static void stm32_exti_h_syscore_deinit(void)
613{
614 unregister_syscore_ops(&stm32_exti_h_syscore_ops);
615}
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000616
617static struct irq_chip stm32_exti_h_chip = {
618 .name = "stm32-exti-h",
619 .irq_eoi = stm32_exti_h_eoi,
620 .irq_mask = stm32_exti_h_mask,
621 .irq_unmask = stm32_exti_h_unmask,
622 .irq_retrigger = irq_chip_retrigger_hierarchy,
623 .irq_set_type = stm32_exti_h_set_type,
624 .irq_set_wake = stm32_exti_h_set_wake,
625 .flags = IRQCHIP_MASK_ON_SUSPEND,
626 .irq_set_affinity = IS_ENABLED(CONFIG_SMP) ? stm32_exti_h_set_affinity : NULL,
627};
628
629static int stm32_exti_h_domain_alloc(struct irq_domain *dm,
630 unsigned int virq,
631 unsigned int nr_irqs, void *data)
632{
633 struct stm32_exti_host_data *host_data = dm->host_data;
634 struct stm32_exti_chip_data *chip_data;
635 struct irq_fwspec *fwspec = data;
636 struct irq_fwspec p_fwspec;
637 irq_hw_number_t hwirq;
638 int p_irq, bank;
639
640 hwirq = fwspec->param[0];
641 bank = hwirq / IRQS_PER_BANK;
642 chip_data = &host_data->chips_data[bank];
643
644 irq_domain_set_hwirq_and_chip(dm, virq, hwirq,
645 &stm32_exti_h_chip, chip_data);
646
647 p_irq = stm32_exti_to_irq(host_data->drv_data, hwirq);
648 if (p_irq >= 0) {
649 p_fwspec.fwnode = dm->parent->fwnode;
650 p_fwspec.param_count = 3;
651 p_fwspec.param[0] = GIC_SPI;
652 p_fwspec.param[1] = p_irq;
653 p_fwspec.param[2] = IRQ_TYPE_LEVEL_HIGH;
654
655 return irq_domain_alloc_irqs_parent(dm, virq, 1, &p_fwspec);
656 }
657
658 return 0;
659}
660
661static struct
662stm32_exti_host_data *stm32_exti_host_init(const struct stm32_exti_drv_data *dd,
663 struct device_node *node)
664{
665 struct stm32_exti_host_data *host_data;
666
667 host_data = kzalloc(sizeof(*host_data), GFP_KERNEL);
668 if (!host_data)
669 return NULL;
670
671 host_data->drv_data = dd;
672 host_data->chips_data = kcalloc(dd->bank_nr,
673 sizeof(struct stm32_exti_chip_data),
674 GFP_KERNEL);
675 if (!host_data->chips_data)
676 goto free_host_data;
677
678 host_data->base = of_iomap(node, 0);
679 if (!host_data->base) {
680 pr_err("%pOF: Unable to map registers\n", node);
681 goto free_chips_data;
682 }
683
684 stm32_host_data = host_data;
685
686 return host_data;
687
688free_chips_data:
689 kfree(host_data->chips_data);
690free_host_data:
691 kfree(host_data);
692
693 return NULL;
694}
695
696static struct
697stm32_exti_chip_data *stm32_exti_chip_init(struct stm32_exti_host_data *h_data,
698 u32 bank_idx,
699 struct device_node *node)
700{
701 const struct stm32_exti_bank *stm32_bank;
702 struct stm32_exti_chip_data *chip_data;
703 void __iomem *base = h_data->base;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000704
705 stm32_bank = h_data->drv_data->exti_banks[bank_idx];
706 chip_data = &h_data->chips_data[bank_idx];
707 chip_data->host_data = h_data;
708 chip_data->reg_bank = stm32_bank;
709
710 raw_spin_lock_init(&chip_data->rlock);
711
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000712 /*
713 * This IP has no reset, so after hot reboot we should
714 * clear registers to avoid residue
715 */
716 writel_relaxed(0, base + stm32_bank->imr_ofst);
717 writel_relaxed(0, base + stm32_bank->emr_ofst);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000718
David Brazdil0f672f62019-12-10 10:32:29 +0000719 pr_info("%pOF: bank%d\n", node, bank_idx);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000720
721 return chip_data;
722}
723
724static int __init stm32_exti_init(const struct stm32_exti_drv_data *drv_data,
725 struct device_node *node)
726{
727 struct stm32_exti_host_data *host_data;
728 unsigned int clr = IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN;
729 int nr_irqs, ret, i;
730 struct irq_chip_generic *gc;
731 struct irq_domain *domain;
732
733 host_data = stm32_exti_host_init(drv_data, node);
734 if (!host_data)
735 return -ENOMEM;
736
737 domain = irq_domain_add_linear(node, drv_data->bank_nr * IRQS_PER_BANK,
738 &irq_exti_domain_ops, NULL);
739 if (!domain) {
David Brazdil0f672f62019-12-10 10:32:29 +0000740 pr_err("%pOFn: Could not register interrupt domain.\n",
741 node);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000742 ret = -ENOMEM;
743 goto out_unmap;
744 }
745
746 ret = irq_alloc_domain_generic_chips(domain, IRQS_PER_BANK, 1, "exti",
747 handle_edge_irq, clr, 0, 0);
748 if (ret) {
749 pr_err("%pOF: Could not allocate generic interrupt chip.\n",
750 node);
751 goto out_free_domain;
752 }
753
754 for (i = 0; i < drv_data->bank_nr; i++) {
755 const struct stm32_exti_bank *stm32_bank;
756 struct stm32_exti_chip_data *chip_data;
757
758 stm32_bank = drv_data->exti_banks[i];
759 chip_data = stm32_exti_chip_init(host_data, i, node);
760
761 gc = irq_get_domain_generic_chip(domain, i * IRQS_PER_BANK);
762
763 gc->reg_base = host_data->base;
764 gc->chip_types->type = IRQ_TYPE_EDGE_BOTH;
765 gc->chip_types->chip.irq_ack = stm32_irq_ack;
766 gc->chip_types->chip.irq_mask = irq_gc_mask_clr_bit;
767 gc->chip_types->chip.irq_unmask = irq_gc_mask_set_bit;
768 gc->chip_types->chip.irq_set_type = stm32_irq_set_type;
769 gc->chip_types->chip.irq_set_wake = irq_gc_set_wake;
770 gc->suspend = stm32_irq_suspend;
771 gc->resume = stm32_irq_resume;
772 gc->wake_enabled = IRQ_MSK(IRQS_PER_BANK);
773
774 gc->chip_types->regs.mask = stm32_bank->imr_ofst;
775 gc->private = (void *)chip_data;
776 }
777
778 nr_irqs = of_irq_count(node);
779 for (i = 0; i < nr_irqs; i++) {
780 unsigned int irq = irq_of_parse_and_map(node, i);
781
782 irq_set_handler_data(irq, domain);
783 irq_set_chained_handler(irq, stm32_irq_handler);
784 }
785
786 return 0;
787
788out_free_domain:
789 irq_domain_remove(domain);
790out_unmap:
791 iounmap(host_data->base);
792 kfree(host_data->chips_data);
793 kfree(host_data);
794 return ret;
795}
796
797static const struct irq_domain_ops stm32_exti_h_domain_ops = {
798 .alloc = stm32_exti_h_domain_alloc,
799 .free = irq_domain_free_irqs_common,
David Brazdil0f672f62019-12-10 10:32:29 +0000800 .xlate = irq_domain_xlate_twocell,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000801};
802
David Brazdil0f672f62019-12-10 10:32:29 +0000803static void stm32_exti_remove_irq(void *data)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000804{
David Brazdil0f672f62019-12-10 10:32:29 +0000805 struct irq_domain *domain = data;
806
807 irq_domain_remove(domain);
808}
809
810static int stm32_exti_remove(struct platform_device *pdev)
811{
812 stm32_exti_h_syscore_deinit();
813 return 0;
814}
815
816static int stm32_exti_probe(struct platform_device *pdev)
817{
818 int ret, i;
819 struct device *dev = &pdev->dev;
820 struct device_node *np = dev->of_node;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000821 struct irq_domain *parent_domain, *domain;
822 struct stm32_exti_host_data *host_data;
David Brazdil0f672f62019-12-10 10:32:29 +0000823 const struct stm32_exti_drv_data *drv_data;
824 struct resource *res;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000825
David Brazdil0f672f62019-12-10 10:32:29 +0000826 host_data = devm_kzalloc(dev, sizeof(*host_data), GFP_KERNEL);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000827 if (!host_data)
828 return -ENOMEM;
829
David Brazdil0f672f62019-12-10 10:32:29 +0000830 /* check for optional hwspinlock which may be not available yet */
831 ret = of_hwspin_lock_get_id(np, 0);
832 if (ret == -EPROBE_DEFER)
833 /* hwspinlock framework not yet ready */
834 return ret;
835
836 if (ret >= 0) {
837 host_data->hwlock = devm_hwspin_lock_request_specific(dev, ret);
838 if (!host_data->hwlock) {
839 dev_err(dev, "Failed to request hwspinlock\n");
840 return -EINVAL;
841 }
842 } else if (ret != -ENOENT) {
843 /* note: ENOENT is a valid case (means 'no hwspinlock') */
844 dev_err(dev, "Failed to get hwspinlock\n");
845 return ret;
846 }
847
848 /* initialize host_data */
849 drv_data = of_device_get_match_data(dev);
850 if (!drv_data) {
851 dev_err(dev, "no of match data\n");
852 return -ENODEV;
853 }
854 host_data->drv_data = drv_data;
855
856 host_data->chips_data = devm_kcalloc(dev, drv_data->bank_nr,
857 sizeof(*host_data->chips_data),
858 GFP_KERNEL);
859 if (!host_data->chips_data)
860 return -ENOMEM;
861
862 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
863 host_data->base = devm_ioremap_resource(dev, res);
864 if (IS_ERR(host_data->base)) {
865 dev_err(dev, "Unable to map registers\n");
866 return PTR_ERR(host_data->base);
867 }
868
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000869 for (i = 0; i < drv_data->bank_nr; i++)
David Brazdil0f672f62019-12-10 10:32:29 +0000870 stm32_exti_chip_init(host_data, i, np);
871
872 parent_domain = irq_find_host(of_irq_find_parent(np));
873 if (!parent_domain) {
874 dev_err(dev, "GIC interrupt-parent not found\n");
875 return -EINVAL;
876 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000877
878 domain = irq_domain_add_hierarchy(parent_domain, 0,
879 drv_data->bank_nr * IRQS_PER_BANK,
David Brazdil0f672f62019-12-10 10:32:29 +0000880 np, &stm32_exti_h_domain_ops,
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000881 host_data);
882
883 if (!domain) {
David Brazdil0f672f62019-12-10 10:32:29 +0000884 dev_err(dev, "Could not register exti domain\n");
885 return -ENOMEM;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000886 }
887
David Brazdil0f672f62019-12-10 10:32:29 +0000888 ret = devm_add_action_or_reset(dev, stm32_exti_remove_irq, domain);
889 if (ret)
890 return ret;
891
892 stm32_exti_h_syscore_init(host_data);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000893
894 return 0;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000895}
896
David Brazdil0f672f62019-12-10 10:32:29 +0000897/* platform driver only for MP1 */
898static const struct of_device_id stm32_exti_ids[] = {
899 { .compatible = "st,stm32mp1-exti", .data = &stm32mp1_drv_data},
900 {},
901};
902MODULE_DEVICE_TABLE(of, stm32_exti_ids);
903
904static struct platform_driver stm32_exti_driver = {
905 .probe = stm32_exti_probe,
906 .remove = stm32_exti_remove,
907 .driver = {
908 .name = "stm32_exti",
909 .of_match_table = stm32_exti_ids,
910 },
911};
912
913static int __init stm32_exti_arch_init(void)
914{
915 return platform_driver_register(&stm32_exti_driver);
916}
917
918static void __exit stm32_exti_arch_exit(void)
919{
920 return platform_driver_unregister(&stm32_exti_driver);
921}
922
923arch_initcall(stm32_exti_arch_init);
924module_exit(stm32_exti_arch_exit);
925
926/* no platform driver for F4 and H7 */
Andrew Scullb4b6d4a2019-01-02 15:54:55 +0000927static int __init stm32f4_exti_of_init(struct device_node *np,
928 struct device_node *parent)
929{
930 return stm32_exti_init(&stm32f4xx_drv_data, np);
931}
932
933IRQCHIP_DECLARE(stm32f4_exti, "st,stm32-exti", stm32f4_exti_of_init);
934
935static int __init stm32h7_exti_of_init(struct device_node *np,
936 struct device_node *parent)
937{
938 return stm32_exti_init(&stm32h7xx_drv_data, np);
939}
940
941IRQCHIP_DECLARE(stm32h7_exti, "st,stm32h7-exti", stm32h7_exti_of_init);