| /* | |
| * Linux/m68k general interrupt handling code from arch/m68k/kernel/ints.c | |
| * Needed to drive the m68k emulating IRQ hardware on the PowerUp boards. | |
| */ | |
| #include <linux/types.h> | |
| #include <linux/sched.h> | |
| #include <linux/kernel_stat.h> | |
| #include <linux/errno.h> | |
| #include <linux/init.h> | |
| #include <linux/seq_file.h> | |
| #include <asm/setup.h> | |
| #include <asm/system.h> | |
| #include <asm/irq.h> | |
| #include <asm/traps.h> | |
| #include <asm/page.h> | |
| #include <asm/machdep.h> | |
| /* table for system interrupt handlers */ | |
| static irq_handler_t irq_list[SYS_IRQS]; | |
| static const char *default_names[SYS_IRQS] = { | |
| "spurious int", "int1 handler", "int2 handler", "int3 handler", | |
| "int4 handler", "int5 handler", "int6 handler", "int7 handler" | |
| }; | |
| /* The number of spurious interrupts */ | |
| volatile unsigned int num_spurious; | |
| #define NUM_IRQ_NODES 100 | |
| static irq_node_t nodes[NUM_IRQ_NODES]; | |
| /* | |
| * void init_IRQ(void) | |
| * | |
| * Parameters: None | |
| * | |
| * Returns: Nothing | |
| * | |
| * This function should be called during kernel startup to initialize | |
| * the IRQ handling routines. | |
| */ | |
| __init | |
| void m68k_init_IRQ(void) | |
| { | |
| int i; | |
| for (i = 0; i < SYS_IRQS; i++) { | |
| if (mach_default_handler) | |
| irq_list[i].handler = (*mach_default_handler)[i]; | |
| irq_list[i].flags = 0; | |
| irq_list[i].dev_id = NULL; | |
| irq_list[i].devname = default_names[i]; | |
| } | |
| for (i = 0; i < NUM_IRQ_NODES; i++) | |
| nodes[i].handler = NULL; | |
| mach_init_IRQ (); | |
| } | |
| irq_node_t *new_irq_node(void) | |
| { | |
| irq_node_t *node; | |
| short i; | |
| for (node = nodes, i = NUM_IRQ_NODES-1; i >= 0; node++, i--) | |
| if (!node->handler) | |
| return node; | |
| printk ("new_irq_node: out of nodes\n"); | |
| return NULL; | |
| } | |
| int sys_request_irq(unsigned int irq, | |
| void (*handler)(int, void *, struct pt_regs *), | |
| unsigned long flags, const char *devname, void *dev_id) | |
| { | |
| if (irq < IRQ1 || irq > IRQ7) { | |
| printk("%s: Incorrect IRQ %d from %s\n", | |
| __FUNCTION__, irq, devname); | |
| return -ENXIO; | |
| } | |
| #if 0 | |
| if (!(irq_list[irq].flags & IRQ_FLG_STD)) { | |
| if (irq_list[irq].flags & IRQ_FLG_LOCK) { | |
| printk("%s: IRQ %d from %s is not replaceable\n", | |
| __FUNCTION__, irq, irq_list[irq].devname); | |
| return -EBUSY; | |
| } | |
| if (!(flags & IRQ_FLG_REPLACE)) { | |
| printk("%s: %s can't replace IRQ %d from %s\n", | |
| __FUNCTION__, devname, irq, irq_list[irq].devname); | |
| return -EBUSY; | |
| } | |
| } | |
| #endif | |
| irq_list[irq].handler = handler; | |
| irq_list[irq].flags = flags; | |
| irq_list[irq].dev_id = dev_id; | |
| irq_list[irq].devname = devname; | |
| return 0; | |
| } | |
| void sys_free_irq(unsigned int irq, void *dev_id) | |
| { | |
| if (irq < IRQ1 || irq > IRQ7) { | |
| printk("%s: Incorrect IRQ %d\n", __FUNCTION__, irq); | |
| return; | |
| } | |
| if (irq_list[irq].dev_id != dev_id) | |
| printk("%s: Removing probably wrong IRQ %d from %s\n", | |
| __FUNCTION__, irq, irq_list[irq].devname); | |
| irq_list[irq].handler = (*mach_default_handler)[irq]; | |
| irq_list[irq].flags = 0; | |
| irq_list[irq].dev_id = NULL; | |
| irq_list[irq].devname = default_names[irq]; | |
| } | |
| asmlinkage void process_int(unsigned long vec, struct pt_regs *fp) | |
| { | |
| if (vec >= VEC_INT1 && vec <= VEC_INT7 && !MACH_IS_BVME6000) { | |
| vec -= VEC_SPUR; | |
| kstat_cpu(0).irqs[vec]++; | |
| irq_list[vec].handler(vec, irq_list[vec].dev_id, fp); | |
| } else { | |
| if (mach_process_int) | |
| mach_process_int(vec, fp); | |
| else | |
| panic("Can't process interrupt vector %ld\n", vec); | |
| return; | |
| } | |
| } | |
| int m68k_get_irq_list(struct seq_file *p, void *v) | |
| { | |
| int i; | |
| /* autovector interrupts */ | |
| if (mach_default_handler) { | |
| for (i = 0; i < SYS_IRQS; i++) { | |
| seq_printf(p, "auto %2d: %10u ", i, | |
| i ? kstat_cpu(0).irqs[i] : num_spurious); | |
| seq_puts(p, " "); | |
| seq_printf(p, "%s\n", irq_list[i].devname); | |
| } | |
| } | |
| mach_get_irq_list(p, v); | |
| return 0; | |
| } |