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
26
27
28
29
30
31
32
33
34
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#include <linux/module.h>
44
45#include <asm/system.h>
46#include <asm/traps.h>
47
48#include <asm/atarihw.h>
49#include <asm/atariints.h>
50#include <asm/atari_stdma.h>
51#include <asm/irq.h>
52#include <asm/entry.h>
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108#if 0
109
110#define NUM_INT_SOURCES (8 + NUM_ATARI_SOURCES)
111
112typedef void (*asm_irq_handler)(void);
113
114struct irqhandler {
115 irqreturn_t (*handler)(int, void *, struct pt_regs *);
116 void *dev_id;
117};
118
119struct irqparam {
120 unsigned long flags;
121 const char *devname;
122};
123
124
125
126
127
128
129static struct irqhandler irq_handler[NUM_INT_SOURCES];
130
131
132
133
134
135
136static struct irqparam irq_param[NUM_INT_SOURCES];
137
138
139#define IS_VALID_INTNO(n) \
140 ((n) > 0 && \
141 \
142 (((n) < TTMFP_SOURCE_BASE) || \
143 \
144 ((n) >= TTMFP_SOURCE_BASE && (n) < SCC_SOURCE_BASE && \
145 ATARIHW_PRESENT(TT_MFP)) || \
146 \
147 ((n) >= SCC_SOURCE_BASE && (n) < VME_SOURCE_BASE && \
148 !((n) & 1) && ATARIHW_PRESENT(SCC)) || \
149 \
150 ((n) >= VME_SOURCE_BASE && (n) < VME_SOURCE_BASE + VME_MAX_SOURCES && \
151 free_vme_vec_bitmap & (1 << ((n) - VME_SOURCE_BASE)))))
152
153
154
155
156
157
158#define IRQ_NAME(nr) atari_slow_irq_##nr##_handler(void)
159
160#define BUILD_SLOW_IRQ(n) \
161asmlinkage void IRQ_NAME(n); \
162 \
163void atari_slow_irq_##n##_dummy (void) { \
164__asm__ (__ALIGN_STR "\n" \
165"atari_slow_irq_" #n "_handler:\t" \
166" addl %6,%5\n" \
167 SAVE_ALL_INT "\n" \
168 GET_CURRENT(%%d0) "\n" \
169" andb #~(1<<(%c3&7)),%a4:w\n" \
170 \
171" bfextu %%sp@(%c2){#5,#3},%%d0\n" \
172" movew %%sr,%%d1\n" \
173" bfins %%d0,%%d1{#21,#3}\n" \
174" movew %%d1,%%sr\n" \
175" addql #1,%a0\n" \
176" lea %a1,%%a0\n" \
177" pea %%sp@\n" \
178" movel %%a0@(4),%%sp@-\n" \
179" pea (%c3+8)\n" \
180" movel %%a0@,%%a0\n" \
181" jbsr %%a0@\n" \
182" addql #8,%%sp\n" \
183" addql #4,%%sp\n" \
184" orw #0x0600,%%sr\n" \
185" andw #0xfeff,%%sr\n" \
186" orb #(1<<(%c3&7)),%a4:w\n" \
187" jbra ret_from_interrupt\n" \
188 : : "i" (&kstat_cpu(0).irqs[n+8]), "i" (&irq_handler[n+8]), \
189 "n" (PT_OFF_SR), "n" (n), \
190 "i" (n & 8 ? (n & 16 ? &tt_mfp.int_mk_a : &st_mfp.int_mk_a) \
191 : (n & 16 ? &tt_mfp.int_mk_b : &st_mfp.int_mk_b)), \
192 "m" (preempt_count()), "di" (HARDIRQ_OFFSET) \
193); \
194 for (;;); \
195}
196
197BUILD_SLOW_IRQ(0);
198BUILD_SLOW_IRQ(1);
199BUILD_SLOW_IRQ(2);
200BUILD_SLOW_IRQ(3);
201BUILD_SLOW_IRQ(4);
202BUILD_SLOW_IRQ(5);
203BUILD_SLOW_IRQ(6);
204BUILD_SLOW_IRQ(7);
205BUILD_SLOW_IRQ(8);
206BUILD_SLOW_IRQ(9);
207BUILD_SLOW_IRQ(10);
208BUILD_SLOW_IRQ(11);
209BUILD_SLOW_IRQ(12);
210BUILD_SLOW_IRQ(13);
211BUILD_SLOW_IRQ(14);
212BUILD_SLOW_IRQ(15);
213BUILD_SLOW_IRQ(16);
214BUILD_SLOW_IRQ(17);
215BUILD_SLOW_IRQ(18);
216BUILD_SLOW_IRQ(19);
217BUILD_SLOW_IRQ(20);
218BUILD_SLOW_IRQ(21);
219BUILD_SLOW_IRQ(22);
220BUILD_SLOW_IRQ(23);
221BUILD_SLOW_IRQ(24);
222BUILD_SLOW_IRQ(25);
223BUILD_SLOW_IRQ(26);
224BUILD_SLOW_IRQ(27);
225BUILD_SLOW_IRQ(28);
226BUILD_SLOW_IRQ(29);
227BUILD_SLOW_IRQ(30);
228BUILD_SLOW_IRQ(31);
229
230asm_irq_handler slow_handlers[32] = {
231 [0] = atari_slow_irq_0_handler,
232 [1] = atari_slow_irq_1_handler,
233 [2] = atari_slow_irq_2_handler,
234 [3] = atari_slow_irq_3_handler,
235 [4] = atari_slow_irq_4_handler,
236 [5] = atari_slow_irq_5_handler,
237 [6] = atari_slow_irq_6_handler,
238 [7] = atari_slow_irq_7_handler,
239 [8] = atari_slow_irq_8_handler,
240 [9] = atari_slow_irq_9_handler,
241 [10] = atari_slow_irq_10_handler,
242 [11] = atari_slow_irq_11_handler,
243 [12] = atari_slow_irq_12_handler,
244 [13] = atari_slow_irq_13_handler,
245 [14] = atari_slow_irq_14_handler,
246 [15] = atari_slow_irq_15_handler,
247 [16] = atari_slow_irq_16_handler,
248 [17] = atari_slow_irq_17_handler,
249 [18] = atari_slow_irq_18_handler,
250 [19] = atari_slow_irq_19_handler,
251 [20] = atari_slow_irq_20_handler,
252 [21] = atari_slow_irq_21_handler,
253 [22] = atari_slow_irq_22_handler,
254 [23] = atari_slow_irq_23_handler,
255 [24] = atari_slow_irq_24_handler,
256 [25] = atari_slow_irq_25_handler,
257 [26] = atari_slow_irq_26_handler,
258 [27] = atari_slow_irq_27_handler,
259 [28] = atari_slow_irq_28_handler,
260 [29] = atari_slow_irq_29_handler,
261 [30] = atari_slow_irq_30_handler,
262 [31] = atari_slow_irq_31_handler
263};
264
265asmlinkage void atari_fast_irq_handler( void );
266asmlinkage void atari_prio_irq_handler( void );
267
268
269void atari_fast_prio_irq_dummy (void) {
270__asm__ (__ALIGN_STR "\n"
271"atari_fast_irq_handler:\n\t"
272 "orw #0x700,%%sr\n"
273"atari_prio_irq_handler:\n\t"
274 "addl %3,%2\n\t"
275 SAVE_ALL_INT "\n\t"
276 GET_CURRENT(%%d0) "\n\t"
277
278 "bfextu %%sp@(%c1){#4,#10},%%d0\n\t"
279 "subw #(0x40-8),%%d0\n\t"
280 "jpl 1f\n\t"
281 "addw #(0x40-8-0x18),%%d0\n"
282 "1:\tlea %a0,%%a0\n\t"
283 "addql #1,%%a0@(%%d0:l:4)\n\t"
284 "lea irq_handler,%%a0\n\t"
285 "lea %%a0@(%%d0:l:8),%%a0\n\t"
286 "pea %%sp@\n\t"
287 "movel %%a0@(4),%%sp@-\n\t"
288 "movel %%d0,%%sp@-\n\t"
289 "movel %%a0@,%%a0\n\t"
290 "jsr %%a0@\n\t"
291 "addql #8,%%sp\n\t"
292 "addql #4,%%sp\n\t"
293 "jbra ret_from_interrupt"
294 : : "i" (&kstat_cpu(0).irqs), "n" (PT_OFF_FORMATVEC),
295 "m" (preempt_count()), "di" (HARDIRQ_OFFSET)
296);
297 for (;;);
298}
299#endif
300
301
302
303
304
305
306static int free_vme_vec_bitmap;
307
308
309
310
311
312asmlinkage void falcon_hblhandler(void);
313asm(".text\n"
314__ALIGN_STR "\n\t"
315"falcon_hblhandler:\n\t"
316 "orw #0x200,%sp@\n\t"
317 "rte");
318
319extern void atari_microwire_cmd(int cmd);
320
321extern int atari_SCC_reset_done;
322
323static int atari_startup_irq(unsigned int irq)
324{
325 m68k_irq_startup(irq);
326 atari_turnon_irq(irq);
327 atari_enable_irq(irq);
328 return 0;
329}
330
331static void atari_shutdown_irq(unsigned int irq)
332{
333 atari_disable_irq(irq);
334 atari_turnoff_irq(irq);
335 m68k_irq_shutdown(irq);
336
337 if (irq == IRQ_AUTO_4)
338 vectors[VEC_INT4] = falcon_hblhandler;
339}
340
341static struct irq_controller atari_irq_controller = {
342 .name = "atari",
343 .lock = __SPIN_LOCK_UNLOCKED(atari_irq_controller.lock),
344 .startup = atari_startup_irq,
345 .shutdown = atari_shutdown_irq,
346 .enable = atari_enable_irq,
347 .disable = atari_disable_irq,
348};
349
350
351
352
353
354
355
356
357
358
359
360
361void __init atari_init_IRQ(void)
362{
363 m68k_setup_user_interrupt(VEC_USER, NUM_ATARI_SOURCES - IRQ_USER, NULL);
364 m68k_setup_irq_controller(&atari_irq_controller, 1, NUM_ATARI_SOURCES - 1);
365
366
367
368#ifdef ATARI_USE_SOFTWARE_EOI
369 st_mfp.vec_adr = 0x48;
370#else
371 st_mfp.vec_adr = 0x40;
372#endif
373 st_mfp.int_en_a = 0x00;
374 st_mfp.int_en_b = 0x00;
375 st_mfp.int_mk_a = 0xff;
376 st_mfp.int_mk_b = 0xff;
377
378 if (ATARIHW_PRESENT(TT_MFP)) {
379#ifdef ATARI_USE_SOFTWARE_EOI
380 tt_mfp.vec_adr = 0x58;
381#else
382 tt_mfp.vec_adr = 0x50;
383#endif
384 tt_mfp.int_en_a = 0x00;
385 tt_mfp.int_en_b = 0x00;
386 tt_mfp.int_mk_a = 0xff;
387 tt_mfp.int_mk_b = 0xff;
388 }
389
390 if (ATARIHW_PRESENT(SCC) && !atari_SCC_reset_done) {
391 scc.cha_a_ctrl = 9;
392 MFPDELAY();
393 scc.cha_a_ctrl = (char) 0xc0;
394 }
395
396 if (ATARIHW_PRESENT(SCU)) {
397
398 tt_scu.sys_mask = 0x10;
399
400
401
402
403 tt_scu.vme_mask = 0x60;
404 } else {
405
406
407
408
409
410 vectors[VEC_INT2] = falcon_hblhandler;
411 vectors[VEC_INT4] = falcon_hblhandler;
412 }
413
414 if (ATARIHW_PRESENT(PCM_8BIT) && ATARIHW_PRESENT(MICROWIRE)) {
415
416
417
418 atari_microwire_cmd(MW_LM1992_PSG_HIGH);
419 }
420
421 stdma_init();
422
423
424 sound_ym.rd_data_reg_sel = 7;
425 sound_ym.wd_data = 0xff;
426}
427
428
429
430
431
432
433
434unsigned long atari_register_vme_int(void)
435{
436 int i;
437
438 for (i = 0; i < 32; i++)
439 if ((free_vme_vec_bitmap & (1 << i)) == 0)
440 break;
441
442 if (i == 16)
443 return 0;
444
445 free_vme_vec_bitmap |= 1 << i;
446 return VME_SOURCE_BASE + i;
447}
448EXPORT_SYMBOL(atari_register_vme_int);
449
450
451void atari_unregister_vme_int(unsigned long irq)
452{
453 if (irq >= VME_SOURCE_BASE && irq < VME_SOURCE_BASE + VME_MAX_SOURCES) {
454 irq -= VME_SOURCE_BASE;
455 free_vme_vec_bitmap &= ~(1 << irq);
456 }
457}
458EXPORT_SYMBOL(atari_unregister_vme_int);
459
460
461