| /* | 
 |  *  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; | 
 | } |