1 // SPDX-License-Identifier: GPL-2.0-or-later
5 * Copyright (C) 2013 Alexander Shiyan <shc_work@mail.ru>
10 #include <linux/irqchip.h>
11 #include <linux/irqdomain.h>
12 #include <linux/of_address.h>
13 #include <linux/of_irq.h>
14 #include <linux/slab.h>
16 #include <asm/exception.h>
17 #include <asm/mach/irq.h>
19 #define CLPS711X_INTSR1 (0x0240)
20 #define CLPS711X_INTMR1 (0x0280)
21 #define CLPS711X_BLEOI (0x0600)
22 #define CLPS711X_MCEOI (0x0640)
23 #define CLPS711X_TEOI (0x0680)
24 #define CLPS711X_TC1EOI (0x06c0)
25 #define CLPS711X_TC2EOI (0x0700)
26 #define CLPS711X_RTCEOI (0x0740)
27 #define CLPS711X_UMSEOI (0x0780)
28 #define CLPS711X_COEOI (0x07c0)
29 #define CLPS711X_INTSR2 (0x1240)
30 #define CLPS711X_INTMR2 (0x1280)
31 #define CLPS711X_SRXEOF (0x1600)
32 #define CLPS711X_KBDEOI (0x1700)
33 #define CLPS711X_INTSR3 (0x2240)
34 #define CLPS711X_INTMR3 (0x2280)
37 #define CLPS711X_FLAG_EN (1 << 0)
38 #define CLPS711X_FLAG_FIQ (1 << 1)
42 [1] = { CLPS711X_FLAG_FIQ, CLPS711X_BLEOI, },
43 [3] = { CLPS711X_FLAG_FIQ, CLPS711X_MCEOI, },
44 [4] = { CLPS711X_FLAG_EN, CLPS711X_COEOI, },
45 [5] = { CLPS711X_FLAG_EN, },
46 [6] = { CLPS711X_FLAG_EN, },
47 [7] = { CLPS711X_FLAG_EN, },
48 [8] = { CLPS711X_FLAG_EN, CLPS711X_TC1EOI, },
49 [9] = { CLPS711X_FLAG_EN, CLPS711X_TC2EOI, },
50 [10] = { CLPS711X_FLAG_EN, CLPS711X_RTCEOI, },
51 [11] = { CLPS711X_FLAG_EN, CLPS711X_TEOI, },
52 [12] = { CLPS711X_FLAG_EN, },
53 [13] = { CLPS711X_FLAG_EN, },
54 [14] = { CLPS711X_FLAG_EN, CLPS711X_UMSEOI, },
55 [15] = { CLPS711X_FLAG_EN, CLPS711X_SRXEOF, },
56 [16] = { CLPS711X_FLAG_EN, CLPS711X_KBDEOI, },
57 [17] = { CLPS711X_FLAG_EN, },
58 [18] = { CLPS711X_FLAG_EN, },
59 [28] = { CLPS711X_FLAG_EN, },
60 [29] = { CLPS711X_FLAG_EN, },
61 [32] = { CLPS711X_FLAG_FIQ, },
66 void __iomem *intmr[3];
67 void __iomem *intsr[3];
68 struct irq_domain *domain;
69 struct irq_domain_ops ops;
72 static asmlinkage void __exception_irq_entry clps711x_irqh(struct pt_regs *regs)
77 irqstat = readw_relaxed(clps711x_intc->intmr[0]) &
78 readw_relaxed(clps711x_intc->intsr[0]);
80 handle_domain_irq(clps711x_intc->domain,
81 fls(irqstat) - 1, regs);
83 irqstat = readw_relaxed(clps711x_intc->intmr[1]) &
84 readw_relaxed(clps711x_intc->intsr[1]);
86 handle_domain_irq(clps711x_intc->domain,
87 fls(irqstat) - 1 + 16, regs);
91 static void clps711x_intc_eoi(struct irq_data *d)
93 irq_hw_number_t hwirq = irqd_to_hwirq(d);
95 writel_relaxed(0, clps711x_intc->base + clps711x_irqs[hwirq].eoi);
98 static void clps711x_intc_mask(struct irq_data *d)
100 irq_hw_number_t hwirq = irqd_to_hwirq(d);
101 void __iomem *intmr = clps711x_intc->intmr[hwirq / 16];
104 tmp = readl_relaxed(intmr);
105 tmp &= ~(1 << (hwirq % 16));
106 writel_relaxed(tmp, intmr);
109 static void clps711x_intc_unmask(struct irq_data *d)
111 irq_hw_number_t hwirq = irqd_to_hwirq(d);
112 void __iomem *intmr = clps711x_intc->intmr[hwirq / 16];
115 tmp = readl_relaxed(intmr);
116 tmp |= 1 << (hwirq % 16);
117 writel_relaxed(tmp, intmr);
120 static struct irq_chip clps711x_intc_chip = {
121 .name = "clps711x-intc",
122 .irq_eoi = clps711x_intc_eoi,
123 .irq_mask = clps711x_intc_mask,
124 .irq_unmask = clps711x_intc_unmask,
127 static int __init clps711x_intc_irq_map(struct irq_domain *h, unsigned int virq,
130 irq_flow_handler_t handler = handle_level_irq;
131 unsigned int flags = 0;
133 if (!clps711x_irqs[hw].flags)
136 if (clps711x_irqs[hw].flags & CLPS711X_FLAG_FIQ) {
137 handler = handle_bad_irq;
138 flags |= IRQ_NOAUTOEN;
139 } else if (clps711x_irqs[hw].eoi) {
140 handler = handle_fasteoi_irq;
143 /* Clear down pending interrupt */
144 if (clps711x_irqs[hw].eoi)
145 writel_relaxed(0, clps711x_intc->base + clps711x_irqs[hw].eoi);
147 irq_set_chip_and_handler(virq, &clps711x_intc_chip, handler);
148 irq_modify_status(virq, IRQ_NOPROBE, flags);
153 static int __init _clps711x_intc_init(struct device_node *np,
154 phys_addr_t base, resource_size_t size)
158 clps711x_intc = kzalloc(sizeof(*clps711x_intc), GFP_KERNEL);
162 clps711x_intc->base = ioremap(base, size);
163 if (!clps711x_intc->base) {
168 clps711x_intc->intsr[0] = clps711x_intc->base + CLPS711X_INTSR1;
169 clps711x_intc->intmr[0] = clps711x_intc->base + CLPS711X_INTMR1;
170 clps711x_intc->intsr[1] = clps711x_intc->base + CLPS711X_INTSR2;
171 clps711x_intc->intmr[1] = clps711x_intc->base + CLPS711X_INTMR2;
172 clps711x_intc->intsr[2] = clps711x_intc->base + CLPS711X_INTSR3;
173 clps711x_intc->intmr[2] = clps711x_intc->base + CLPS711X_INTMR3;
175 /* Mask all interrupts */
176 writel_relaxed(0, clps711x_intc->intmr[0]);
177 writel_relaxed(0, clps711x_intc->intmr[1]);
178 writel_relaxed(0, clps711x_intc->intmr[2]);
180 err = irq_alloc_descs(-1, 0, ARRAY_SIZE(clps711x_irqs), numa_node_id());
184 clps711x_intc->ops.map = clps711x_intc_irq_map;
185 clps711x_intc->ops.xlate = irq_domain_xlate_onecell;
186 clps711x_intc->domain =
187 irq_domain_add_legacy(np, ARRAY_SIZE(clps711x_irqs),
188 0, 0, &clps711x_intc->ops, NULL);
189 if (!clps711x_intc->domain) {
194 irq_set_default_host(clps711x_intc->domain);
195 set_handle_irq(clps711x_irqh);
204 irq_free_descs(0, ARRAY_SIZE(clps711x_irqs));
207 iounmap(clps711x_intc->base);
210 kfree(clps711x_intc);
215 void __init clps711x_intc_init(phys_addr_t base, resource_size_t size)
217 BUG_ON(_clps711x_intc_init(NULL, base, size));
220 #ifdef CONFIG_IRQCHIP
221 static int __init clps711x_intc_init_dt(struct device_node *np,
222 struct device_node *parent)
227 err = of_address_to_resource(np, 0, &res);
231 return _clps711x_intc_init(np, res.start, resource_size(&res));
233 IRQCHIP_DECLARE(clps711x, "cirrus,ep7209-intc", clps711x_intc_init_dt);