blob: 065b7a31a47833a3cbe444f3e8779611ca2ede3a [file] [log] [blame]
Russell Kingc41b16f2011-01-19 15:32:15 +00001/*
2 * Support for Versatile FPGA-based IRQ controllers
3 */
Linus Walleij3a6ca8c2012-10-27 01:05:06 +02004#include <linux/bitops.h>
Russell Kingc41b16f2011-01-19 15:32:15 +00005#include <linux/irq.h>
6#include <linux/io.h>
Linus Walleij2389d502012-10-31 22:04:31 +01007#include <linux/irqchip/versatile-fpga.h>
Linus Walleij3108e6a2012-04-28 14:33:47 +01008#include <linux/irqdomain.h>
9#include <linux/module.h>
Linus Walleij9bc15032012-09-06 09:07:57 +010010#include <linux/of.h>
11#include <linux/of_address.h>
Russell Kingc41b16f2011-01-19 15:32:15 +000012
Linus Walleij3108e6a2012-04-28 14:33:47 +010013#include <asm/exception.h>
Russell Kingc41b16f2011-01-19 15:32:15 +000014#include <asm/mach/irq.h>
Russell Kingc41b16f2011-01-19 15:32:15 +000015
16#define IRQ_STATUS 0x00
17#define IRQ_RAW_STATUS 0x04
18#define IRQ_ENABLE_SET 0x08
19#define IRQ_ENABLE_CLEAR 0x0c
Linus Walleij9bc15032012-09-06 09:07:57 +010020#define INT_SOFT_SET 0x10
21#define INT_SOFT_CLEAR 0x14
22#define FIQ_STATUS 0x20
23#define FIQ_RAW_STATUS 0x24
24#define FIQ_ENABLE 0x28
25#define FIQ_ENABLE_SET 0x28
26#define FIQ_ENABLE_CLEAR 0x2C
Russell Kingc41b16f2011-01-19 15:32:15 +000027
Linus Walleij3108e6a2012-04-28 14:33:47 +010028/**
29 * struct fpga_irq_data - irq data container for the FPGA IRQ controller
30 * @base: memory offset in virtual memory
Linus Walleij3108e6a2012-04-28 14:33:47 +010031 * @chip: chip container for this instance
32 * @domain: IRQ domain for this instance
33 * @valid: mask for valid IRQs on this controller
34 * @used_irqs: number of active IRQs on this controller
35 */
36struct fpga_irq_data {
37 void __iomem *base;
Linus Walleij3108e6a2012-04-28 14:33:47 +010038 struct irq_chip chip;
39 u32 valid;
40 struct irq_domain *domain;
41 u8 used_irqs;
42};
43
44/* we cannot allocate memory when the controllers are initially registered */
Linus Walleij2389d502012-10-31 22:04:31 +010045static struct fpga_irq_data fpga_irq_devices[CONFIG_VERSATILE_FPGA_IRQ_NR];
Linus Walleij3108e6a2012-04-28 14:33:47 +010046static int fpga_irq_id;
47
Russell Kingc41b16f2011-01-19 15:32:15 +000048static void fpga_irq_mask(struct irq_data *d)
49{
50 struct fpga_irq_data *f = irq_data_get_irq_chip_data(d);
Linus Walleij3108e6a2012-04-28 14:33:47 +010051 u32 mask = 1 << d->hwirq;
Russell Kingc41b16f2011-01-19 15:32:15 +000052
53 writel(mask, f->base + IRQ_ENABLE_CLEAR);
54}
55
56static void fpga_irq_unmask(struct irq_data *d)
57{
58 struct fpga_irq_data *f = irq_data_get_irq_chip_data(d);
Linus Walleij3108e6a2012-04-28 14:33:47 +010059 u32 mask = 1 << d->hwirq;
Russell Kingc41b16f2011-01-19 15:32:15 +000060
61 writel(mask, f->base + IRQ_ENABLE_SET);
62}
63
64static void fpga_irq_handle(unsigned int irq, struct irq_desc *desc)
65{
Thomas Gleixner6845664a2011-03-24 13:25:22 +010066 struct fpga_irq_data *f = irq_desc_get_handler_data(desc);
Russell Kingc41b16f2011-01-19 15:32:15 +000067 u32 status = readl(f->base + IRQ_STATUS);
68
69 if (status == 0) {
70 do_bad_IRQ(irq, desc);
71 return;
72 }
73
74 do {
75 irq = ffs(status) - 1;
76 status &= ~(1 << irq);
Linus Walleij3108e6a2012-04-28 14:33:47 +010077 generic_handle_irq(irq_find_mapping(f->domain, irq));
Russell Kingc41b16f2011-01-19 15:32:15 +000078 } while (status);
79}
80
Linus Walleij3108e6a2012-04-28 14:33:47 +010081/*
82 * Handle each interrupt in a single FPGA IRQ controller. Returns non-zero
83 * if we've handled at least one interrupt. This does a single read of the
84 * status register and handles all interrupts in order from LSB first.
85 */
86static int handle_one_fpga(struct fpga_irq_data *f, struct pt_regs *regs)
Russell Kingc41b16f2011-01-19 15:32:15 +000087{
Linus Walleij3108e6a2012-04-28 14:33:47 +010088 int handled = 0;
89 int irq;
90 u32 status;
Russell Kingc41b16f2011-01-19 15:32:15 +000091
Linus Walleij3108e6a2012-04-28 14:33:47 +010092 while ((status = readl(f->base + IRQ_STATUS))) {
93 irq = ffs(status) - 1;
94 handle_IRQ(irq_find_mapping(f->domain, irq), regs);
95 handled = 1;
96 }
97
98 return handled;
99}
100
101/*
102 * Keep iterating over all registered FPGA IRQ controllers until there are
103 * no pending interrupts.
104 */
105asmlinkage void __exception_irq_entry fpga_handle_irq(struct pt_regs *regs)
106{
107 int i, handled;
108
109 do {
110 for (i = 0, handled = 0; i < fpga_irq_id; ++i)
111 handled |= handle_one_fpga(&fpga_irq_devices[i], regs);
112 } while (handled);
113}
114
115static int fpga_irqdomain_map(struct irq_domain *d, unsigned int irq,
116 irq_hw_number_t hwirq)
117{
118 struct fpga_irq_data *f = d->host_data;
119
120 /* Skip invalid IRQs, only register handlers for the real ones */
Linus Walleij3a6ca8c2012-10-27 01:05:06 +0200121 if (!(f->valid & BIT(hwirq)))
Linus Walleij3108e6a2012-04-28 14:33:47 +0100122 return -ENOTSUPP;
123 irq_set_chip_data(irq, f);
124 irq_set_chip_and_handler(irq, &f->chip,
125 handle_level_irq);
126 set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
Linus Walleij3108e6a2012-04-28 14:33:47 +0100127 return 0;
128}
129
130static struct irq_domain_ops fpga_irqdomain_ops = {
131 .map = fpga_irqdomain_map,
132 .xlate = irq_domain_xlate_onetwocell,
133};
134
Linus Walleij3a6ca8c2012-10-27 01:05:06 +0200135void __init fpga_irq_init(void __iomem *base, const char *name, int irq_start,
136 int parent_irq, u32 valid, struct device_node *node)
137{
Linus Walleij3108e6a2012-04-28 14:33:47 +0100138 struct fpga_irq_data *f;
Linus Walleij3a6ca8c2012-10-27 01:05:06 +0200139 int i;
Linus Walleij3108e6a2012-04-28 14:33:47 +0100140
141 if (fpga_irq_id >= ARRAY_SIZE(fpga_irq_devices)) {
Paul Bollee6423f82013-03-25 10:34:46 +0100142 pr_err("%s: too few FPGA IRQ controllers, increase CONFIG_VERSATILE_FPGA_IRQ_NR\n", __func__);
Linus Walleij3a6ca8c2012-10-27 01:05:06 +0200143 return;
Linus Walleij3108e6a2012-04-28 14:33:47 +0100144 }
Linus Walleij3108e6a2012-04-28 14:33:47 +0100145 f = &fpga_irq_devices[fpga_irq_id];
146 f->base = base;
Linus Walleij3108e6a2012-04-28 14:33:47 +0100147 f->chip.name = name;
Russell Kingc41b16f2011-01-19 15:32:15 +0000148 f->chip.irq_ack = fpga_irq_mask;
149 f->chip.irq_mask = fpga_irq_mask;
150 f->chip.irq_unmask = fpga_irq_unmask;
Linus Walleij3108e6a2012-04-28 14:33:47 +0100151 f->valid = valid;
Russell Kingc41b16f2011-01-19 15:32:15 +0000152
153 if (parent_irq != -1) {
Thomas Gleixner6845664a2011-03-24 13:25:22 +0100154 irq_set_handler_data(parent_irq, f);
155 irq_set_chained_handler(parent_irq, fpga_irq_handle);
Russell Kingc41b16f2011-01-19 15:32:15 +0000156 }
157
Linus Walleij3a6ca8c2012-10-27 01:05:06 +0200158 /* This will also allocate irq descriptors */
159 f->domain = irq_domain_add_simple(node, fls(valid), irq_start,
Linus Walleij3108e6a2012-04-28 14:33:47 +0100160 &fpga_irqdomain_ops, f);
Linus Walleij3a6ca8c2012-10-27 01:05:06 +0200161
162 /* This will allocate all valid descriptors in the linear case */
163 for (i = 0; i < fls(valid); i++)
164 if (valid & BIT(i)) {
165 if (!irq_start)
166 irq_create_mapping(f->domain, i);
167 f->used_irqs++;
168 }
169
Linus Walleij3108e6a2012-04-28 14:33:47 +0100170 pr_info("FPGA IRQ chip %d \"%s\" @ %p, %u irqs\n",
171 fpga_irq_id, name, base, f->used_irqs);
Linus Walleij3a6ca8c2012-10-27 01:05:06 +0200172
173 fpga_irq_id++;
Russell Kingc41b16f2011-01-19 15:32:15 +0000174}
Linus Walleij9bc15032012-09-06 09:07:57 +0100175
176#ifdef CONFIG_OF
177int __init fpga_irq_of_init(struct device_node *node,
178 struct device_node *parent)
179{
Linus Walleij9bc15032012-09-06 09:07:57 +0100180 void __iomem *base;
181 u32 clear_mask;
182 u32 valid_mask;
183
184 if (WARN_ON(!node))
185 return -ENODEV;
186
187 base = of_iomap(node, 0);
188 WARN(!base, "unable to map fpga irq registers\n");
189
190 if (of_property_read_u32(node, "clear-mask", &clear_mask))
191 clear_mask = 0;
192
193 if (of_property_read_u32(node, "valid-mask", &valid_mask))
194 valid_mask = 0;
195
Linus Walleij3a6ca8c2012-10-27 01:05:06 +0200196 fpga_irq_init(base, node->name, 0, -1, valid_mask, node);
Linus Walleij9bc15032012-09-06 09:07:57 +0100197
198 writel(clear_mask, base + IRQ_ENABLE_CLEAR);
199 writel(clear_mask, base + FIQ_ENABLE_CLEAR);
200
Linus Walleij9bc15032012-09-06 09:07:57 +0100201 return 0;
202}
203#endif