13bd41bed28e52d600ef76e6d0beaa4abee33b62
[pandora-kernel.git] / arch / m68k / apollo / dn_ints.c
1 #include <linux/interrupt.h>
2
3 #include <asm/irq.h>
4 #include <asm/traps.h>
5 #include <asm/apollohw.h>
6
7 void dn_process_int(unsigned int irq, struct pt_regs *fp)
8 {
9         __m68k_handle_int(irq, fp);
10
11         *(volatile unsigned char *)(pica)=0x20;
12         *(volatile unsigned char *)(picb)=0x20;
13 }
14
15 int apollo_irq_startup(unsigned int irq)
16 {
17         if (irq < 8)
18                 *(volatile unsigned char *)(pica+1) &= ~(1 << irq);
19         else
20                 *(volatile unsigned char *)(picb+1) &= ~(1 << (irq - 8));
21         return 0;
22 }
23
24 void apollo_irq_shutdown(unsigned int irq)
25 {
26         if (irq < 8)
27                 *(volatile unsigned char *)(pica+1) |= (1 << irq);
28         else
29                 *(volatile unsigned char *)(picb+1) |= (1 << (irq - 8));
30 }
31
32 static struct irq_controller apollo_irq_controller = {
33         .name           = "apollo",
34         .lock           = __SPIN_LOCK_UNLOCKED(apollo_irq_controller.lock),
35         .startup        = apollo_irq_startup,
36         .shutdown       = apollo_irq_shutdown,
37 };
38
39
40 void dn_init_IRQ(void)
41 {
42         m68k_setup_user_interrupt(VEC_USER + 96, 16, dn_process_int);
43         m68k_setup_irq_controller(&apollo_irq_controller, IRQ_APOLLO, 16);
44 }