This source file includes following definitions.
- fpga_mask_irq
- get_fpga_unmasked_irqs
- fpga_ack_irq
- fpga_unmask_irq
- fpga_mask_ack_irq
- innovator_fpga_IRQ_demux
- omap1510_fpga_init_irq
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16 #include <linux/types.h>
17 #include <linux/gpio.h>
18 #include <linux/init.h>
19 #include <linux/kernel.h>
20 #include <linux/device.h>
21 #include <linux/errno.h>
22 #include <linux/io.h>
23
24 #include <asm/irq.h>
25 #include <asm/mach/irq.h>
26
27 #include <mach/hardware.h>
28
29 #include "iomap.h"
30 #include "common.h"
31 #include "fpga.h"
32
33 static void fpga_mask_irq(struct irq_data *d)
34 {
35 unsigned int irq = d->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
49 static 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
61 static void fpga_ack_irq(struct irq_data *d)
62 {
63
64 }
65
66 static void fpga_unmask_irq(struct irq_data *d)
67 {
68 unsigned int irq = d->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
81 static void fpga_mask_ack_irq(struct irq_data *d)
82 {
83 fpga_mask_irq(d);
84 fpga_ack_irq(d);
85 }
86
87 static void innovator_fpga_IRQ_demux(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
106 static struct irq_chip omap_fpga_irq_ack = {
107 .name = "FPGA-ack",
108 .irq_ack = fpga_mask_ack_irq,
109 .irq_mask = fpga_mask_irq,
110 .irq_unmask = fpga_unmask_irq,
111 };
112
113
114 static struct irq_chip omap_fpga_irq = {
115 .name = "FPGA",
116 .irq_ack = fpga_ack_irq,
117 .irq_mask = fpga_mask_irq,
118 .irq_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 void omap1510_fpga_init_irq(void)
144 {
145 int i, res;
146
147 __raw_writeb(0, OMAP1510_FPGA_IMR_LO);
148 __raw_writeb(0, OMAP1510_FPGA_IMR_HI);
149 __raw_writeb(0, INNOVATOR_FPGA_IMR2);
150
151 for (i = OMAP_FPGA_IRQ_BASE; i < OMAP_FPGA_IRQ_END; i++) {
152
153 if (i == OMAP1510_INT_FPGA_TS) {
154
155
156
157
158 irq_set_chip(i, &omap_fpga_irq_ack);
159 }
160 else {
161
162
163
164
165 irq_set_chip(i, &omap_fpga_irq);
166 }
167
168 irq_set_handler(i, handle_edge_irq);
169 irq_clear_status_flags(i, IRQ_NOREQUEST);
170 }
171
172
173
174
175
176
177
178
179 res = gpio_request(13, "FPGA irq");
180 if (res) {
181 pr_err("%s failed to get gpio\n", __func__);
182 return;
183 }
184 gpio_direction_input(13);
185 irq_set_irq_type(gpio_to_irq(13), IRQ_TYPE_EDGE_RISING);
186 irq_set_chained_handler(OMAP1510_INT_FPGA, innovator_fpga_IRQ_demux);
187 }