This source file includes following definitions.
- disable_irq
- enable_irq
- do_bottom_half
- do_IRQ
- do_fast_IRQ
- irqaction
- request_irq
- free_irq
- math_error_irq
- no_action
- init_IRQ
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25 #include <linux/ptrace.h>
26 #include <linux/errno.h>
27 #include <linux/signal.h>
28 #include <linux/sched.h>
29 #include <linux/interrupt.h>
30
31 #include <asm/system.h>
32 #include <asm/io.h>
33 #include <asm/irq.h>
34
35 #define CR0_NE 32
36
37 static unsigned char cache_21 = 0xff;
38 static unsigned char cache_A1 = 0xff;
39
40 unsigned long intr_count = 0;
41 unsigned long bh_active = 0;
42 unsigned long bh_mask = 0xFFFFFFFF;
43 struct bh_struct bh_base[32];
44
45 void disable_irq(unsigned int irq_nr)
46 {
47 unsigned long flags;
48 unsigned char mask;
49
50 mask = 1 << (irq_nr & 7);
51 save_flags(flags);
52 if (irq_nr < 8) {
53 cli();
54 cache_21 |= mask;
55 outb(cache_21,0x21);
56 restore_flags(flags);
57 return;
58 }
59 cli();
60 cache_A1 |= mask;
61 outb(cache_A1,0xA1);
62 restore_flags(flags);
63 }
64
65 void enable_irq(unsigned int irq_nr)
66 {
67 unsigned long flags;
68 unsigned char mask;
69
70 mask = ~(1 << (irq_nr & 7));
71 save_flags(flags);
72 if (irq_nr < 8) {
73 cli();
74 cache_21 &= mask;
75 outb(cache_21,0x21);
76 restore_flags(flags);
77 return;
78 }
79 cli();
80 cache_A1 &= mask;
81 outb(cache_A1,0xA1);
82 restore_flags(flags);
83 }
84
85
86
87
88
89
90 asmlinkage void do_bottom_half(void)
91 {
92 unsigned long active;
93 unsigned long mask, left;
94 struct bh_struct *bh;
95
96 bh = bh_base;
97 active = bh_active & bh_mask;
98 for (mask = 1, left = ~0 ; left & active ; bh++,mask += mask,left += left) {
99 if (mask & active) {
100 void (*fn)(void *);
101 bh_active &= ~mask;
102 fn = bh->routine;
103 if (!fn)
104 goto bad_bh;
105 fn(bh->data);
106 }
107 }
108 return;
109 bad_bh:
110 printk ("irq.c:bad bottom half entry\n");
111 }
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128 BUILD_IRQ(FIRST,0,0x01)
129 BUILD_IRQ(FIRST,1,0x02)
130 BUILD_IRQ(FIRST,2,0x04)
131 BUILD_IRQ(FIRST,3,0x08)
132 BUILD_IRQ(FIRST,4,0x10)
133 BUILD_IRQ(FIRST,5,0x20)
134 BUILD_IRQ(FIRST,6,0x40)
135 BUILD_IRQ(FIRST,7,0x80)
136 BUILD_IRQ(SECOND,8,0x01)
137 BUILD_IRQ(SECOND,9,0x02)
138 BUILD_IRQ(SECOND,10,0x04)
139 BUILD_IRQ(SECOND,11,0x08)
140 BUILD_IRQ(SECOND,12,0x10)
141 BUILD_IRQ(SECOND,13,0x20)
142 BUILD_IRQ(SECOND,14,0x40)
143 BUILD_IRQ(SECOND,15,0x80)
144
145
146
147
148
149 static void (*interrupt[16])(void) = {
150 IRQ0_interrupt, IRQ1_interrupt, IRQ2_interrupt, IRQ3_interrupt,
151 IRQ4_interrupt, IRQ5_interrupt, IRQ6_interrupt, IRQ7_interrupt,
152 IRQ8_interrupt, IRQ9_interrupt, IRQ10_interrupt, IRQ11_interrupt,
153 IRQ12_interrupt, IRQ13_interrupt, IRQ14_interrupt, IRQ15_interrupt
154 };
155
156 static void (*fast_interrupt[16])(void) = {
157 fast_IRQ0_interrupt, fast_IRQ1_interrupt,
158 fast_IRQ2_interrupt, fast_IRQ3_interrupt,
159 fast_IRQ4_interrupt, fast_IRQ5_interrupt,
160 fast_IRQ6_interrupt, fast_IRQ7_interrupt,
161 fast_IRQ8_interrupt, fast_IRQ9_interrupt,
162 fast_IRQ10_interrupt, fast_IRQ11_interrupt,
163 fast_IRQ12_interrupt, fast_IRQ13_interrupt,
164 fast_IRQ14_interrupt, fast_IRQ15_interrupt
165 };
166
167 static void (*bad_interrupt[16])(void) = {
168 bad_IRQ0_interrupt, bad_IRQ1_interrupt,
169 bad_IRQ2_interrupt, bad_IRQ3_interrupt,
170 bad_IRQ4_interrupt, bad_IRQ5_interrupt,
171 bad_IRQ6_interrupt, bad_IRQ7_interrupt,
172 bad_IRQ8_interrupt, bad_IRQ9_interrupt,
173 bad_IRQ10_interrupt, bad_IRQ11_interrupt,
174 bad_IRQ12_interrupt, bad_IRQ13_interrupt,
175 bad_IRQ14_interrupt, bad_IRQ15_interrupt
176 };
177
178
179
180
181 static struct sigaction irq_sigaction[16] = {
182 { NULL, 0, 0, NULL }, { NULL, 0, 0, NULL },
183 { NULL, 0, 0, NULL }, { NULL, 0, 0, NULL },
184 { NULL, 0, 0, NULL }, { NULL, 0, 0, NULL },
185 { NULL, 0, 0, NULL }, { NULL, 0, 0, NULL },
186 { NULL, 0, 0, NULL }, { NULL, 0, 0, NULL },
187 { NULL, 0, 0, NULL }, { NULL, 0, 0, NULL },
188 { NULL, 0, 0, NULL }, { NULL, 0, 0, NULL },
189 { NULL, 0, 0, NULL }, { NULL, 0, 0, NULL }
190 };
191
192
193
194
195
196
197
198
199 asmlinkage void do_IRQ(int irq, struct pt_regs * regs)
200 {
201 struct sigaction * sa = irq + irq_sigaction;
202
203 sa->sa_handler((int) regs);
204 }
205
206
207
208
209
210
211 asmlinkage void do_fast_IRQ(int irq)
212 {
213 struct sigaction * sa = irq + irq_sigaction;
214
215 sa->sa_handler(irq);
216 }
217
218 int irqaction(unsigned int irq, struct sigaction * new_sa)
219 {
220 struct sigaction * sa;
221 unsigned long flags;
222
223 if (irq > 15)
224 return -EINVAL;
225 sa = irq + irq_sigaction;
226 if (sa->sa_mask)
227 return -EBUSY;
228 if (!new_sa->sa_handler)
229 return -EINVAL;
230 save_flags(flags);
231 cli();
232 *sa = *new_sa;
233 sa->sa_mask = 1;
234 if (sa->sa_flags & SA_INTERRUPT)
235 set_intr_gate(0x20+irq,fast_interrupt[irq]);
236 else
237 set_intr_gate(0x20+irq,interrupt[irq]);
238 if (irq < 8) {
239 cache_21 &= ~(1<<irq);
240 outb(cache_21,0x21);
241 } else {
242 cache_21 &= ~(1<<2);
243 cache_A1 &= ~(1<<(irq-8));
244 outb(cache_21,0x21);
245 outb(cache_A1,0xA1);
246 }
247 restore_flags(flags);
248 return 0;
249 }
250
251 int request_irq(unsigned int irq, void (*handler)(int))
252 {
253 struct sigaction sa;
254
255 sa.sa_handler = handler;
256 sa.sa_flags = 0;
257 sa.sa_mask = 0;
258 sa.sa_restorer = NULL;
259 return irqaction(irq,&sa);
260 }
261
262 void free_irq(unsigned int irq)
263 {
264 struct sigaction * sa = irq + irq_sigaction;
265 unsigned long flags;
266
267 if (irq > 15) {
268 printk("Trying to free IRQ%d\n",irq);
269 return;
270 }
271 if (!sa->sa_mask) {
272 printk("Trying to free free IRQ%d\n",irq);
273 return;
274 }
275 save_flags(flags);
276 cli();
277 if (irq < 8) {
278 cache_21 |= 1 << irq;
279 outb(cache_21,0x21);
280 } else {
281 cache_A1 |= 1 << (irq-8);
282 outb(cache_A1,0xA1);
283 }
284 set_intr_gate(0x20+irq,bad_interrupt[irq]);
285 sa->sa_handler = NULL;
286 sa->sa_flags = 0;
287 sa->sa_mask = 0;
288 sa->sa_restorer = NULL;
289 restore_flags(flags);
290 }
291
292
293
294
295
296
297
298
299
300
301
302
303 static void math_error_irq(int cpl)
304 {
305 outb(0,0xF0);
306 if (ignore_irq13)
307 return;
308 math_error();
309 }
310
311 static void no_action(int cpl) { }
312
313 static struct sigaction ignore_IRQ = {
314 no_action,
315 0,
316 SA_INTERRUPT,
317 NULL
318 };
319
320 void init_IRQ(void)
321 {
322 int i;
323
324 for (i = 0; i < 16 ; i++)
325 set_intr_gate(0x20+i,bad_interrupt[i]);
326 if (irqaction(2,&ignore_IRQ))
327 printk("Unable to get IRQ2 for cascade\n");
328 if (request_irq(13,math_error_irq))
329 printk("Unable to get IRQ13 for math-error handler\n");
330
331
332 for (i = 0; i < 32; i++) {
333 bh_base[i].routine = NULL;
334 bh_base[i].data = NULL;
335 }
336 bh_active = 0;
337 intr_count = 0;
338 }