]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * arch/m68k/atari/ataints.c -- Atari Linux interrupt handling code | |
3 | * | |
4 | * 5/2/94 Roman Hodek: | |
5 | * Added support for TT interrupts; setup for TT SCU (may someone has | |
6 | * twiddled there and we won't get the right interrupts :-() | |
7 | * | |
8 | * Major change: The device-independent code in m68k/ints.c didn't know | |
9 | * about non-autovec ints yet. It hardcoded the number of possible ints to | |
10 | * 7 (IRQ1...IRQ7). But the Atari has lots of non-autovec ints! I made the | |
11 | * number of possible ints a constant defined in interrupt.h, which is | |
12 | * 47 for the Atari. So we can call request_irq() for all Atari interrupts | |
13 | * just the normal way. Additionally, all vectors >= 48 are initialized to | |
14 | * call trap() instead of inthandler(). This must be changed here, too. | |
15 | * | |
16 | * 1995-07-16 Lars Brinkhoff <[email protected]>: | |
17 | * Corrected a bug in atari_add_isr() which rejected all SCC | |
18 | * interrupt sources if there were no TT MFP! | |
19 | * | |
20 | * 12/13/95: New interface functions atari_level_triggered_int() and | |
21 | * atari_register_vme_int() as support for level triggered VME interrupts. | |
22 | * | |
23 | * 02/12/96: (Roman) | |
24 | * Total rewrite of Atari interrupt handling, for new scheme see comments | |
25 | * below. | |
26 | * | |
27 | * 1996-09-03 lars brinkhoff <[email protected]>: | |
28 | * Added new function atari_unregister_vme_int(), and | |
29 | * modified atari_register_vme_int() as well as IS_VALID_INTNO() | |
30 | * to work with it. | |
31 | * | |
32 | * This file is subject to the terms and conditions of the GNU General Public | |
33 | * License. See the file COPYING in the main directory of this archive | |
34 | * for more details. | |
35 | * | |
36 | */ | |
37 | ||
38 | #include <linux/types.h> | |
39 | #include <linux/kernel.h> | |
40 | #include <linux/kernel_stat.h> | |
41 | #include <linux/init.h> | |
42 | #include <linux/seq_file.h> | |
43 | ||
44 | #include <asm/system.h> | |
45 | #include <asm/traps.h> | |
46 | ||
47 | #include <asm/atarihw.h> | |
48 | #include <asm/atariints.h> | |
49 | #include <asm/atari_stdma.h> | |
50 | #include <asm/irq.h> | |
51 | #include <asm/entry.h> | |
52 | ||
53 | ||
54 | /* | |
55 | * Atari interrupt handling scheme: | |
56 | * -------------------------------- | |
57 | * | |
58 | * All interrupt source have an internal number (defined in | |
59 | * <asm/atariints.h>): Autovector interrupts are 1..7, then follow ST-MFP, | |
60 | * TT-MFP, SCC, and finally VME interrupts. Vector numbers for the latter can | |
61 | * be allocated by atari_register_vme_int(). | |
62 | * | |
63 | * Each interrupt can be of three types: | |
64 | * | |
65 | * - SLOW: The handler runs with all interrupts enabled, except the one it | |
66 | * was called by (to avoid reentering). This should be the usual method. | |
67 | * But it is currently possible only for MFP ints, since only the MFP | |
68 | * offers an easy way to mask interrupts. | |
69 | * | |
70 | * - FAST: The handler runs with all interrupts disabled. This should be used | |
71 | * only for really fast handlers, that just do actions immediately | |
72 | * necessary, and let the rest do a bottom half or task queue. | |
73 | * | |
74 | * - PRIORITIZED: The handler can be interrupted by higher-level ints | |
75 | * (greater IPL, no MFP priorities!). This is the method of choice for ints | |
76 | * which should be slow, but are not from a MFP. | |
77 | * | |
78 | * The feature of more than one handler for one int source is still there, but | |
79 | * only applicable if all handers are of the same type. To not slow down | |
80 | * processing of ints with only one handler by the chaining feature, the list | |
81 | * calling function atari_call_irq_list() is only plugged in at the time the | |
82 | * second handler is registered. | |
83 | * | |
84 | * Implementation notes: For fast-as-possible int handling, there are separate | |
85 | * entry points for each type (slow/fast/prio). The assembler handler calls | |
86 | * the irq directly in the usual case, no C wrapper is involved. In case of | |
87 | * multiple handlers, atari_call_irq_list() is registered as handler and calls | |
88 | * in turn the real irq's. To ease access from assembler level to the irq | |
89 | * function pointer and accompanying data, these two are stored in a separate | |
90 | * array, irq_handler[]. The rest of data (type, name) are put into a second | |
91 | * array, irq_param, that is accessed from C only. For each slow interrupt (32 | |
92 | * in all) there are separate handler functions, which makes it possible to | |
93 | * hard-code the MFP register address and value, are necessary to mask the | |
94 | * int. If there'd be only one generic function, lots of calculations would be | |
95 | * needed to determine MFP register and int mask from the vector number :-( | |
96 | * | |
97 | * Furthermore, slow ints may not lower the IPL below its previous value | |
98 | * (before the int happened). This is needed so that an int of class PRIO, on | |
99 | * that this int may be stacked, cannot be reentered. This feature is | |
100 | * implemented as follows: If the stack frame format is 1 (throwaway), the int | |
101 | * is not stacked, and the IPL is anded with 0xfbff, resulting in a new level | |
102 | * 2, which still blocks the HSYNC, but no interrupts of interest. If the | |
103 | * frame format is 0, the int is nested, and the old IPL value can be found in | |
104 | * the sr copy in the frame. | |
105 | */ | |
106 | ||
107 | ||
108 | #define NUM_INT_SOURCES (8 + NUM_ATARI_SOURCES) | |
109 | ||
110 | typedef void (*asm_irq_handler)(void); | |
111 | ||
112 | struct irqhandler { | |
113 | irqreturn_t (*handler)(int, void *, struct pt_regs *); | |
114 | void *dev_id; | |
115 | }; | |
116 | ||
117 | struct irqparam { | |
118 | unsigned long flags; | |
119 | const char *devname; | |
120 | }; | |
121 | ||
122 | /* | |
123 | * Array with irq's and their parameter data. This array is accessed from low | |
124 | * level assembler code, so an element size of 8 allows usage of index scaling | |
125 | * addressing mode. | |
126 | */ | |
127 | static struct irqhandler irq_handler[NUM_INT_SOURCES]; | |
128 | ||
129 | /* | |
130 | * This array hold the rest of parameters of int handlers: type | |
131 | * (slow,fast,prio) and the name of the handler. These values are only | |
132 | * accessed from C | |
133 | */ | |
134 | static struct irqparam irq_param[NUM_INT_SOURCES]; | |
135 | ||
136 | /* | |
137 | * Bitmap for free interrupt vector numbers | |
138 | * (new vectors starting from 0x70 can be allocated by | |
139 | * atari_register_vme_int()) | |
140 | */ | |
141 | static int free_vme_vec_bitmap; | |
142 | ||
143 | /* check for valid int number (complex, sigh...) */ | |
144 | #define IS_VALID_INTNO(n) \ | |
145 | ((n) > 0 && \ | |
146 | /* autovec and ST-MFP ok anyway */ \ | |
147 | (((n) < TTMFP_SOURCE_BASE) || \ | |
148 | /* TT-MFP ok if present */ \ | |
149 | ((n) >= TTMFP_SOURCE_BASE && (n) < SCC_SOURCE_BASE && \ | |
150 | ATARIHW_PRESENT(TT_MFP)) || \ | |
151 | /* SCC ok if present and number even */ \ | |
152 | ((n) >= SCC_SOURCE_BASE && (n) < VME_SOURCE_BASE && \ | |
153 | !((n) & 1) && ATARIHW_PRESENT(SCC)) || \ | |
154 | /* greater numbers ok if they are registered VME vectors */ \ | |
155 | ((n) >= VME_SOURCE_BASE && (n) < VME_SOURCE_BASE + VME_MAX_SOURCES && \ | |
156 | free_vme_vec_bitmap & (1 << ((n) - VME_SOURCE_BASE))))) | |
157 | ||
158 | ||
159 | /* | |
160 | * Here start the assembler entry points for interrupts | |
161 | */ | |
162 | ||
163 | #define IRQ_NAME(nr) atari_slow_irq_##nr##_handler(void) | |
164 | ||
165 | #define BUILD_SLOW_IRQ(n) \ | |
166 | asmlinkage void IRQ_NAME(n); \ | |
167 | /* Dummy function to allow asm with operands. */ \ | |
168 | void atari_slow_irq_##n##_dummy (void) { \ | |
169 | __asm__ (__ALIGN_STR "\n" \ | |
170 | "atari_slow_irq_" #n "_handler:\t" \ | |
171 | " addl %6,%5\n" /* preempt_count() += HARDIRQ_OFFSET */ \ | |
172 | SAVE_ALL_INT "\n" \ | |
173 | GET_CURRENT(%%d0) "\n" \ | |
174 | " andb #~(1<<(%c3&7)),%a4:w\n" /* mask this interrupt */ \ | |
175 | /* get old IPL from stack frame */ \ | |
176 | " bfextu %%sp@(%c2){#5,#3},%%d0\n" \ | |
177 | " movew %%sr,%%d1\n" \ | |
178 | " bfins %%d0,%%d1{#21,#3}\n" \ | |
179 | " movew %%d1,%%sr\n" /* set IPL = previous value */ \ | |
180 | " addql #1,%a0\n" \ | |
181 | " lea %a1,%%a0\n" \ | |
182 | " pea %%sp@\n" /* push addr of frame */ \ | |
183 | " movel %%a0@(4),%%sp@-\n" /* push handler data */ \ | |
184 | " pea (%c3+8)\n" /* push int number */ \ | |
185 | " movel %%a0@,%%a0\n" \ | |
186 | " jbsr %%a0@\n" /* call the handler */ \ | |
187 | " addql #8,%%sp\n" \ | |
188 | " addql #4,%%sp\n" \ | |
189 | " orw #0x0600,%%sr\n" \ | |
190 | " andw #0xfeff,%%sr\n" /* set IPL = 6 again */ \ | |
191 | " orb #(1<<(%c3&7)),%a4:w\n" /* now unmask the int again */ \ | |
192 | " jbra ret_from_interrupt\n" \ | |
193 | : : "i" (&kstat_cpu(0).irqs[n+8]), "i" (&irq_handler[n+8]), \ | |
194 | "n" (PT_OFF_SR), "n" (n), \ | |
195 | "i" (n & 8 ? (n & 16 ? &tt_mfp.int_mk_a : &mfp.int_mk_a) \ | |
196 | : (n & 16 ? &tt_mfp.int_mk_b : &mfp.int_mk_b)), \ | |
197 | "m" (preempt_count()), "di" (HARDIRQ_OFFSET) \ | |
198 | ); \ | |
199 | for (;;); /* fake noreturn */ \ | |
200 | } | |
201 | ||
202 | BUILD_SLOW_IRQ(0); | |
203 | BUILD_SLOW_IRQ(1); | |
204 | BUILD_SLOW_IRQ(2); | |
205 | BUILD_SLOW_IRQ(3); | |
206 | BUILD_SLOW_IRQ(4); | |
207 | BUILD_SLOW_IRQ(5); | |
208 | BUILD_SLOW_IRQ(6); | |
209 | BUILD_SLOW_IRQ(7); | |
210 | BUILD_SLOW_IRQ(8); | |
211 | BUILD_SLOW_IRQ(9); | |
212 | BUILD_SLOW_IRQ(10); | |
213 | BUILD_SLOW_IRQ(11); | |
214 | BUILD_SLOW_IRQ(12); | |
215 | BUILD_SLOW_IRQ(13); | |
216 | BUILD_SLOW_IRQ(14); | |
217 | BUILD_SLOW_IRQ(15); | |
218 | BUILD_SLOW_IRQ(16); | |
219 | BUILD_SLOW_IRQ(17); | |
220 | BUILD_SLOW_IRQ(18); | |
221 | BUILD_SLOW_IRQ(19); | |
222 | BUILD_SLOW_IRQ(20); | |
223 | BUILD_SLOW_IRQ(21); | |
224 | BUILD_SLOW_IRQ(22); | |
225 | BUILD_SLOW_IRQ(23); | |
226 | BUILD_SLOW_IRQ(24); | |
227 | BUILD_SLOW_IRQ(25); | |
228 | BUILD_SLOW_IRQ(26); | |
229 | BUILD_SLOW_IRQ(27); | |
230 | BUILD_SLOW_IRQ(28); | |
231 | BUILD_SLOW_IRQ(29); | |
232 | BUILD_SLOW_IRQ(30); | |
233 | BUILD_SLOW_IRQ(31); | |
234 | ||
235 | asm_irq_handler slow_handlers[32] = { | |
236 | [0] = atari_slow_irq_0_handler, | |
237 | [1] = atari_slow_irq_1_handler, | |
238 | [2] = atari_slow_irq_2_handler, | |
239 | [3] = atari_slow_irq_3_handler, | |
240 | [4] = atari_slow_irq_4_handler, | |
241 | [5] = atari_slow_irq_5_handler, | |
242 | [6] = atari_slow_irq_6_handler, | |
243 | [7] = atari_slow_irq_7_handler, | |
244 | [8] = atari_slow_irq_8_handler, | |
245 | [9] = atari_slow_irq_9_handler, | |
246 | [10] = atari_slow_irq_10_handler, | |
247 | [11] = atari_slow_irq_11_handler, | |
248 | [12] = atari_slow_irq_12_handler, | |
249 | [13] = atari_slow_irq_13_handler, | |
250 | [14] = atari_slow_irq_14_handler, | |
251 | [15] = atari_slow_irq_15_handler, | |
252 | [16] = atari_slow_irq_16_handler, | |
253 | [17] = atari_slow_irq_17_handler, | |
254 | [18] = atari_slow_irq_18_handler, | |
255 | [19] = atari_slow_irq_19_handler, | |
256 | [20] = atari_slow_irq_20_handler, | |
257 | [21] = atari_slow_irq_21_handler, | |
258 | [22] = atari_slow_irq_22_handler, | |
259 | [23] = atari_slow_irq_23_handler, | |
260 | [24] = atari_slow_irq_24_handler, | |
261 | [25] = atari_slow_irq_25_handler, | |
262 | [26] = atari_slow_irq_26_handler, | |
263 | [27] = atari_slow_irq_27_handler, | |
264 | [28] = atari_slow_irq_28_handler, | |
265 | [29] = atari_slow_irq_29_handler, | |
266 | [30] = atari_slow_irq_30_handler, | |
267 | [31] = atari_slow_irq_31_handler | |
268 | }; | |
269 | ||
270 | asmlinkage void atari_fast_irq_handler( void ); | |
271 | asmlinkage void atari_prio_irq_handler( void ); | |
272 | ||
273 | /* Dummy function to allow asm with operands. */ | |
274 | void atari_fast_prio_irq_dummy (void) { | |
275 | __asm__ (__ALIGN_STR "\n" | |
276 | "atari_fast_irq_handler:\n\t" | |
277 | "orw #0x700,%%sr\n" /* disable all interrupts */ | |
278 | "atari_prio_irq_handler:\n\t" | |
279 | "addl %3,%2\n\t" /* preempt_count() += HARDIRQ_OFFSET */ | |
280 | SAVE_ALL_INT "\n\t" | |
281 | GET_CURRENT(%%d0) "\n\t" | |
282 | /* get vector number from stack frame and convert to source */ | |
283 | "bfextu %%sp@(%c1){#4,#10},%%d0\n\t" | |
284 | "subw #(0x40-8),%%d0\n\t" | |
285 | "jpl 1f\n\t" | |
286 | "addw #(0x40-8-0x18),%%d0\n" | |
287 | "1:\tlea %a0,%%a0\n\t" | |
288 | "addql #1,%%a0@(%%d0:l:4)\n\t" | |
289 | "lea irq_handler,%%a0\n\t" | |
290 | "lea %%a0@(%%d0:l:8),%%a0\n\t" | |
291 | "pea %%sp@\n\t" /* push frame address */ | |
292 | "movel %%a0@(4),%%sp@-\n\t" /* push handler data */ | |
293 | "movel %%d0,%%sp@-\n\t" /* push int number */ | |
294 | "movel %%a0@,%%a0\n\t" | |
295 | "jsr %%a0@\n\t" /* and call the handler */ | |
296 | "addql #8,%%sp\n\t" | |
297 | "addql #4,%%sp\n\t" | |
298 | "jbra ret_from_interrupt" | |
299 | : : "i" (&kstat_cpu(0).irqs), "n" (PT_OFF_FORMATVEC), | |
300 | "m" (preempt_count()), "di" (HARDIRQ_OFFSET) | |
301 | ); | |
302 | for (;;); | |
303 | } | |
304 | ||
305 | /* GK: | |
306 | * HBL IRQ handler for Falcon. Nobody needs it :-) | |
307 | * ++andreas: raise ipl to disable further HBLANK interrupts. | |
308 | */ | |
309 | asmlinkage void falcon_hblhandler(void); | |
310 | asm(".text\n" | |
311 | __ALIGN_STR "\n\t" | |
312 | "falcon_hblhandler:\n\t" | |
313 | "orw #0x200,%sp@\n\t" /* set saved ipl to 2 */ | |
314 | "rte"); | |
315 | ||
316 | /* Defined in entry.S; only increments 'num_spurious' */ | |
317 | asmlinkage void bad_interrupt(void); | |
318 | ||
319 | extern void atari_microwire_cmd( int cmd ); | |
320 | ||
321 | extern int atari_SCC_reset_done; | |
322 | ||
323 | /* | |
324 | * void atari_init_IRQ (void) | |
325 | * | |
326 | * Parameters: None | |
327 | * | |
328 | * Returns: Nothing | |
329 | * | |
330 | * This function should be called during kernel startup to initialize | |
331 | * the atari IRQ handling routines. | |
332 | */ | |
333 | ||
334 | void __init atari_init_IRQ(void) | |
335 | { | |
336 | int i; | |
337 | ||
338 | /* initialize the vector table */ | |
339 | for (i = 0; i < NUM_INT_SOURCES; ++i) { | |
340 | vectors[IRQ_SOURCE_TO_VECTOR(i)] = bad_interrupt; | |
341 | } | |
342 | ||
343 | /* Initialize the MFP(s) */ | |
344 | ||
345 | #ifdef ATARI_USE_SOFTWARE_EOI | |
346 | mfp.vec_adr = 0x48; /* Software EOI-Mode */ | |
347 | #else | |
348 | mfp.vec_adr = 0x40; /* Automatic EOI-Mode */ | |
349 | #endif | |
350 | mfp.int_en_a = 0x00; /* turn off MFP-Ints */ | |
351 | mfp.int_en_b = 0x00; | |
352 | mfp.int_mk_a = 0xff; /* no Masking */ | |
353 | mfp.int_mk_b = 0xff; | |
354 | ||
355 | if (ATARIHW_PRESENT(TT_MFP)) { | |
356 | #ifdef ATARI_USE_SOFTWARE_EOI | |
357 | tt_mfp.vec_adr = 0x58; /* Software EOI-Mode */ | |
358 | #else | |
359 | tt_mfp.vec_adr = 0x50; /* Automatic EOI-Mode */ | |
360 | #endif | |
361 | tt_mfp.int_en_a = 0x00; /* turn off MFP-Ints */ | |
362 | tt_mfp.int_en_b = 0x00; | |
363 | tt_mfp.int_mk_a = 0xff; /* no Masking */ | |
364 | tt_mfp.int_mk_b = 0xff; | |
365 | } | |
366 | ||
367 | if (ATARIHW_PRESENT(SCC) && !atari_SCC_reset_done) { | |
368 | scc.cha_a_ctrl = 9; | |
369 | MFPDELAY(); | |
370 | scc.cha_a_ctrl = (char) 0xc0; /* hardware reset */ | |
371 | } | |
372 | ||
373 | if (ATARIHW_PRESENT(SCU)) { | |
374 | /* init the SCU if present */ | |
375 | tt_scu.sys_mask = 0x10; /* enable VBL (for the cursor) and | |
376 | * disable HSYNC interrupts (who | |
377 | * needs them?) MFP and SCC are | |
378 | * enabled in VME mask | |
379 | */ | |
380 | tt_scu.vme_mask = 0x60; /* enable MFP and SCC ints */ | |
381 | } | |
382 | else { | |
383 | /* If no SCU and no Hades, the HSYNC interrupt needs to be | |
384 | * disabled this way. (Else _inthandler in kernel/sys_call.S | |
385 | * gets overruns) | |
386 | */ | |
387 | ||
388 | if (!MACH_IS_HADES) | |
389 | vectors[VEC_INT2] = falcon_hblhandler; | |
390 | } | |
391 | ||
392 | if (ATARIHW_PRESENT(PCM_8BIT) && ATARIHW_PRESENT(MICROWIRE)) { | |
393 | /* Initialize the LM1992 Sound Controller to enable | |
394 | the PSG sound. This is misplaced here, it should | |
395 | be in an atasound_init(), that doesn't exist yet. */ | |
396 | atari_microwire_cmd(MW_LM1992_PSG_HIGH); | |
397 | } | |
398 | ||
399 | stdma_init(); | |
400 | ||
401 | /* Initialize the PSG: all sounds off, both ports output */ | |
402 | sound_ym.rd_data_reg_sel = 7; | |
403 | sound_ym.wd_data = 0xff; | |
404 | } | |
405 | ||
406 | ||
407 | static irqreturn_t atari_call_irq_list( int irq, void *dev_id, struct pt_regs *fp ) | |
408 | { | |
409 | irq_node_t *node; | |
410 | ||
411 | for (node = (irq_node_t *)dev_id; node; node = node->next) | |
412 | node->handler(irq, node->dev_id, fp); | |
413 | return IRQ_HANDLED; | |
414 | } | |
415 | ||
416 | ||
417 | /* | |
418 | * atari_request_irq : add an interrupt service routine for a particular | |
419 | * machine specific interrupt source. | |
420 | * If the addition was successful, it returns 0. | |
421 | */ | |
422 | ||
423 | int atari_request_irq(unsigned int irq, irqreturn_t (*handler)(int, void *, struct pt_regs *), | |
424 | unsigned long flags, const char *devname, void *dev_id) | |
425 | { | |
426 | int vector; | |
427 | unsigned long oflags = flags; | |
428 | ||
429 | /* | |
430 | * The following is a hack to make some PCI card drivers work, | |
431 | * which set the SA_SHIRQ flag. | |
432 | */ | |
433 | ||
434 | flags &= ~SA_SHIRQ; | |
435 | ||
436 | if (flags == SA_INTERRUPT) { | |
437 | printk ("%s: SA_INTERRUPT changed to IRQ_TYPE_SLOW for %s\n", | |
438 | __FUNCTION__, devname); | |
439 | flags = IRQ_TYPE_SLOW; | |
440 | } | |
441 | if (flags < IRQ_TYPE_SLOW || flags > IRQ_TYPE_PRIO) { | |
442 | printk ("%s: Bad irq type 0x%lx <0x%lx> requested from %s\n", | |
443 | __FUNCTION__, flags, oflags, devname); | |
444 | return -EINVAL; | |
445 | } | |
446 | if (!IS_VALID_INTNO(irq)) { | |
447 | printk ("%s: Unknown irq %d requested from %s\n", | |
448 | __FUNCTION__, irq, devname); | |
449 | return -ENXIO; | |
450 | } | |
451 | vector = IRQ_SOURCE_TO_VECTOR(irq); | |
452 | ||
453 | /* | |
454 | * Check type/source combination: slow ints are (currently) | |
455 | * only possible for MFP-interrupts. | |
456 | */ | |
457 | if (flags == IRQ_TYPE_SLOW && | |
458 | (irq < STMFP_SOURCE_BASE || irq >= SCC_SOURCE_BASE)) { | |
459 | printk ("%s: Slow irq requested for non-MFP source %d from %s\n", | |
460 | __FUNCTION__, irq, devname); | |
461 | return -EINVAL; | |
462 | } | |
463 | ||
464 | if (vectors[vector] == bad_interrupt) { | |
465 | /* int has no handler yet */ | |
466 | irq_handler[irq].handler = handler; | |
467 | irq_handler[irq].dev_id = dev_id; | |
468 | irq_param[irq].flags = flags; | |
469 | irq_param[irq].devname = devname; | |
470 | vectors[vector] = | |
471 | (flags == IRQ_TYPE_SLOW) ? slow_handlers[irq-STMFP_SOURCE_BASE] : | |
472 | (flags == IRQ_TYPE_FAST) ? atari_fast_irq_handler : | |
473 | atari_prio_irq_handler; | |
474 | /* If MFP int, also enable and umask it */ | |
475 | atari_turnon_irq(irq); | |
476 | atari_enable_irq(irq); | |
477 | ||
478 | return 0; | |
479 | } | |
480 | else if (irq_param[irq].flags == flags) { | |
481 | /* old handler is of same type -> handlers can be chained */ | |
482 | irq_node_t *node; | |
483 | unsigned long flags; | |
484 | ||
485 | local_irq_save(flags); | |
486 | ||
487 | if (irq_handler[irq].handler != atari_call_irq_list) { | |
488 | /* Only one handler yet, make a node for this first one */ | |
489 | if (!(node = new_irq_node())) | |
490 | return -ENOMEM; | |
491 | node->handler = irq_handler[irq].handler; | |
492 | node->dev_id = irq_handler[irq].dev_id; | |
493 | node->devname = irq_param[irq].devname; | |
494 | node->next = NULL; | |
495 | ||
496 | irq_handler[irq].handler = atari_call_irq_list; | |
497 | irq_handler[irq].dev_id = node; | |
498 | irq_param[irq].devname = "chained"; | |
499 | } | |
500 | ||
501 | if (!(node = new_irq_node())) | |
502 | return -ENOMEM; | |
503 | node->handler = handler; | |
504 | node->dev_id = dev_id; | |
505 | node->devname = devname; | |
506 | /* new handlers are put in front of the queue */ | |
507 | node->next = irq_handler[irq].dev_id; | |
508 | irq_handler[irq].dev_id = node; | |
509 | ||
510 | local_irq_restore(flags); | |
511 | return 0; | |
512 | } else { | |
513 | printk ("%s: Irq %d allocated by other type int (call from %s)\n", | |
514 | __FUNCTION__, irq, devname); | |
515 | return -EBUSY; | |
516 | } | |
517 | } | |
518 | ||
519 | void atari_free_irq(unsigned int irq, void *dev_id) | |
520 | { | |
521 | unsigned long flags; | |
522 | int vector; | |
523 | irq_node_t **list, *node; | |
524 | ||
525 | if (!IS_VALID_INTNO(irq)) { | |
526 | printk("%s: Unknown irq %d\n", __FUNCTION__, irq); | |
527 | return; | |
528 | } | |
529 | ||
530 | vector = IRQ_SOURCE_TO_VECTOR(irq); | |
531 | if (vectors[vector] == bad_interrupt) | |
532 | goto not_found; | |
533 | ||
534 | local_irq_save(flags); | |
535 | ||
536 | if (irq_handler[irq].handler != atari_call_irq_list) { | |
537 | /* It's the only handler for the interrupt */ | |
538 | if (irq_handler[irq].dev_id != dev_id) { | |
539 | local_irq_restore(flags); | |
540 | goto not_found; | |
541 | } | |
542 | irq_handler[irq].handler = NULL; | |
543 | irq_handler[irq].dev_id = NULL; | |
544 | irq_param[irq].devname = NULL; | |
545 | vectors[vector] = bad_interrupt; | |
546 | /* If MFP int, also disable it */ | |
547 | atari_disable_irq(irq); | |
548 | atari_turnoff_irq(irq); | |
549 | ||
550 | local_irq_restore(flags); | |
551 | return; | |
552 | } | |
553 | ||
554 | /* The interrupt is chained, find the irq on the list */ | |
555 | for(list = (irq_node_t **)&irq_handler[irq].dev_id; *list; list = &(*list)->next) { | |
556 | if ((*list)->dev_id == dev_id) break; | |
557 | } | |
558 | if (!*list) { | |
559 | local_irq_restore(flags); | |
560 | goto not_found; | |
561 | } | |
562 | ||
563 | (*list)->handler = NULL; /* Mark it as free for reallocation */ | |
564 | *list = (*list)->next; | |
565 | ||
566 | /* If there's now only one handler, unchain the interrupt, i.e. plug in | |
567 | * the handler directly again and omit atari_call_irq_list */ | |
568 | node = (irq_node_t *)irq_handler[irq].dev_id; | |
569 | if (node && !node->next) { | |
570 | irq_handler[irq].handler = node->handler; | |
571 | irq_handler[irq].dev_id = node->dev_id; | |
572 | irq_param[irq].devname = node->devname; | |
573 | node->handler = NULL; /* Mark it as free for reallocation */ | |
574 | } | |
575 | ||
576 | local_irq_restore(flags); | |
577 | return; | |
578 | ||
579 | not_found: | |
580 | printk("%s: tried to remove invalid irq\n", __FUNCTION__); | |
581 | return; | |
582 | } | |
583 | ||
584 | ||
585 | /* | |
586 | * atari_register_vme_int() returns the number of a free interrupt vector for | |
587 | * hardware with a programmable int vector (probably a VME board). | |
588 | */ | |
589 | ||
590 | unsigned long atari_register_vme_int(void) | |
591 | { | |
592 | int i; | |
593 | ||
594 | for(i = 0; i < 32; i++) | |
595 | if((free_vme_vec_bitmap & (1 << i)) == 0) | |
596 | break; | |
597 | ||
598 | if(i == 16) | |
599 | return 0; | |
600 | ||
601 | free_vme_vec_bitmap |= 1 << i; | |
602 | return (VME_SOURCE_BASE + i); | |
603 | } | |
604 | ||
605 | ||
606 | void atari_unregister_vme_int(unsigned long irq) | |
607 | { | |
608 | if(irq >= VME_SOURCE_BASE && irq < VME_SOURCE_BASE + VME_MAX_SOURCES) { | |
609 | irq -= VME_SOURCE_BASE; | |
610 | free_vme_vec_bitmap &= ~(1 << irq); | |
611 | } | |
612 | } | |
613 | ||
614 | ||
615 | int show_atari_interrupts(struct seq_file *p, void *v) | |
616 | { | |
617 | int i; | |
618 | ||
619 | for (i = 0; i < NUM_INT_SOURCES; ++i) { | |
620 | if (vectors[IRQ_SOURCE_TO_VECTOR(i)] == bad_interrupt) | |
621 | continue; | |
622 | if (i < STMFP_SOURCE_BASE) | |
623 | seq_printf(p, "auto %2d: %10u ", | |
624 | i, kstat_cpu(0).irqs[i]); | |
625 | else | |
626 | seq_printf(p, "vec $%02x: %10u ", | |
627 | IRQ_SOURCE_TO_VECTOR(i), | |
628 | kstat_cpu(0).irqs[i]); | |
629 | ||
630 | if (irq_handler[i].handler != atari_call_irq_list) { | |
631 | seq_printf(p, "%s\n", irq_param[i].devname); | |
632 | } | |
633 | else { | |
634 | irq_node_t *n; | |
635 | for( n = (irq_node_t *)irq_handler[i].dev_id; n; n = n->next ) { | |
636 | seq_printf(p, "%s\n", n->devname); | |
637 | if (n->next) | |
638 | seq_puts(p, " " ); | |
639 | } | |
640 | } | |
641 | } | |
642 | if (num_spurious) | |
643 | seq_printf(p, "spurio.: %10u\n", num_spurious); | |
644 | ||
645 | return 0; | |
646 | } | |
647 | ||
648 |