1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/types.h>
20#include <linux/init.h>
21#include <linux/kernel.h>
22#include <linux/device.h>
23#include <linux/errno.h>
24#include <linux/io.h>
25
26#include <mach/hardware.h>
27#include <asm/irq.h>
28#include <asm/mach/irq.h>
29
30#include <mach/fpga.h>
31#include <mach/gpio.h>
32
33static void fpga_mask_irq(unsigned int irq)
34{
35 irq -= OMAP_FPGA_IRQ_BASE;
36
37 if (irq < 8)
38 __raw_writeb((__raw_readb(OMAP1510_FPGA_IMR_LO)
39 & ~(1 << irq)), OMAP1510_FPGA_IMR_LO);
40 else if (irq < 16)
41 __raw_writeb((__raw_readb(OMAP1510_FPGA_IMR_HI)
42 & ~(1 << (irq - 8))), OMAP1510_FPGA_IMR_HI);
43 else
44 __raw_writeb((__raw_readb(INNOVATOR_FPGA_IMR2)
45 & ~(1 << (irq - 16))), INNOVATOR_FPGA_IMR2);
46}
47
48
49static inline u32 get_fpga_unmasked_irqs(void)
50{
51 return
52 ((__raw_readb(OMAP1510_FPGA_ISR_LO) &
53 __raw_readb(OMAP1510_FPGA_IMR_LO))) |
54 ((__raw_readb(OMAP1510_FPGA_ISR_HI) &
55 __raw_readb(OMAP1510_FPGA_IMR_HI)) << 8) |
56 ((__raw_readb(INNOVATOR_FPGA_ISR2) &
57 __raw_readb(INNOVATOR_FPGA_IMR2)) << 16);
58}
59
60
61static void fpga_ack_irq(unsigned int irq)
62{
63
64}
65
66static void fpga_unmask_irq(unsigned int irq)
67{
68 irq -= OMAP_FPGA_IRQ_BASE;
69
70 if (irq < 8)
71 __raw_writeb((__raw_readb(OMAP1510_FPGA_IMR_LO) | (1 << irq)),
72 OMAP1510_FPGA_IMR_LO);
73 else if (irq < 16)
74 __raw_writeb((__raw_readb(OMAP1510_FPGA_IMR_HI)
75 | (1 << (irq - 8))), OMAP1510_FPGA_IMR_HI);
76 else
77 __raw_writeb((__raw_readb(INNOVATOR_FPGA_IMR2)
78 | (1 << (irq - 16))), INNOVATOR_FPGA_IMR2);
79}
80
81static void fpga_mask_ack_irq(unsigned int irq)
82{
83 fpga_mask_irq(irq);
84 fpga_ack_irq(irq);
85}
86
87void innovator_fpga_IRQ_demux(unsigned int irq, struct irq_desc *desc)
88{
89 u32 stat;
90 int fpga_irq;
91
92 stat = get_fpga_unmasked_irqs();
93
94 if (!stat)
95 return;
96
97 for (fpga_irq = OMAP_FPGA_IRQ_BASE;
98 (fpga_irq < OMAP_FPGA_IRQ_END) && stat;
99 fpga_irq++, stat >>= 1) {
100 if (stat & 1) {
101 generic_handle_irq(fpga_irq);
102 }
103 }
104}
105
106static struct irq_chip omap_fpga_irq_ack = {
107 .name = "FPGA-ack",
108 .ack = fpga_mask_ack_irq,
109 .mask = fpga_mask_irq,
110 .unmask = fpga_unmask_irq,
111};
112
113
114static struct irq_chip omap_fpga_irq = {
115 .name = "FPGA",
116 .ack = fpga_ack_irq,
117 .mask = fpga_mask_irq,
118 .unmask = fpga_unmask_irq,
119};
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144void omap1510_fpga_init_irq(void)
145{
146 int i;
147
148 __raw_writeb(0, OMAP1510_FPGA_IMR_LO);
149 __raw_writeb(0, OMAP1510_FPGA_IMR_HI);
150 __raw_writeb(0, INNOVATOR_FPGA_IMR2);
151
152 for (i = OMAP_FPGA_IRQ_BASE; i < OMAP_FPGA_IRQ_END; i++) {
153
154 if (i == OMAP1510_INT_FPGA_TS) {
155
156
157
158
159 set_irq_chip(i, &omap_fpga_irq_ack);
160 }
161 else {
162
163
164
165
166 set_irq_chip(i, &omap_fpga_irq);
167 }
168
169 set_irq_handler(i, handle_edge_irq);
170 set_irq_flags(i, IRQF_VALID);
171 }
172
173
174
175
176
177
178
179
180 gpio_request(13, "FPGA irq");
181 gpio_direction_input(13);
182 set_irq_type(gpio_to_irq(13), IRQ_TYPE_EDGE_RISING);
183 set_irq_chained_handler(OMAP1510_INT_FPGA, innovator_fpga_IRQ_demux);
184}
185
186EXPORT_SYMBOL(omap1510_fpga_init_irq);
187