| /* |
| * linux/arch/$(ARCH)/platform/$(PLATFORM)/ints.c |
| * |
| * This file is subject to the terms and conditions of the GNU General Public |
| * License. See the file COPYING in the main directory of this archive |
| * for more details. |
| * |
| * Copyright (c) 2000 Michael Leslie <mleslie@lineo.com> |
| * Copyright (c) 1996 Roman Zippel |
| * Copyright (c) 1999 D. Jeff Dionne <jeff@uclinux.org> |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/types.h> |
| #include <linux/kernel.h> |
| #include <linux/sched.h> |
| #include <linux/kernel_stat.h> |
| #include <linux/errno.h> |
| |
| #include <asm/system.h> |
| #include <asm/irq.h> |
| #include <asm/irqnode.h> |
| #include <asm/traps.h> |
| #include <asm/io.h> |
| #include <asm/machdep.h> |
| #include <asm/setup.h> |
| #include <asm/m68360.h> |
| |
| /* from quicc/commproc.c: */ |
| extern QUICC *pquicc; |
| extern void cpm_interrupt_init(void); |
| |
| #define INTERNAL_IRQS (96) |
| |
| /* assembler routines */ |
| asmlinkage void system_call(void); |
| asmlinkage void buserr(void); |
| asmlinkage void trap(void); |
| asmlinkage irqreturn_t bad_interrupt(void); |
| asmlinkage irqreturn_t inthandler(void); |
| |
| extern void *_ramvec[]; |
| |
| /* The number of spurious interrupts */ |
| volatile unsigned int num_spurious; |
| unsigned int local_irq_count[NR_CPUS]; |
| |
| /* irq node variables for the 32 (potential) on chip sources */ |
| static irq_node_t int_irq_list[INTERNAL_IRQS]; |
| |
| static short int_irq_ablecount[INTERNAL_IRQS]; |
| |
| /* |
| * This function should be called during kernel startup to initialize |
| * IRQ handling routines. |
| */ |
| |
| void init_IRQ(void) |
| { |
| int i; |
| int vba = (CPM_VECTOR_BASE<<4); |
| |
| /* set up the vectors */ |
| _ramvec[2] = buserr; |
| _ramvec[3] = trap; |
| _ramvec[4] = trap; |
| _ramvec[5] = trap; |
| _ramvec[6] = trap; |
| _ramvec[7] = trap; |
| _ramvec[8] = trap; |
| _ramvec[9] = trap; |
| _ramvec[10] = trap; |
| _ramvec[11] = trap; |
| _ramvec[12] = trap; |
| _ramvec[13] = trap; |
| _ramvec[14] = trap; |
| _ramvec[15] = trap; |
| |
| _ramvec[32] = system_call; |
| _ramvec[33] = trap; |
| |
| |
| cpm_interrupt_init(); |
| |
| /* set up CICR for vector base address and irq level */ |
| /* irl = 4, hp = 1f - see MC68360UM p 7-377 */ |
| pquicc->intr_cicr = 0x00e49f00 | vba; |
| |
| /* CPM interrupt vectors: (p 7-376) */ |
| _ramvec[vba+CPMVEC_ERROR] = bad_interrupt; /* Error */ |
| _ramvec[vba+CPMVEC_PIO_PC11] = inthandler; /* pio - pc11 */ |
| _ramvec[vba+CPMVEC_PIO_PC10] = inthandler; /* pio - pc10 */ |
| _ramvec[vba+CPMVEC_SMC2] = inthandler; /* smc2/pip */ |
| _ramvec[vba+CPMVEC_SMC1] = inthandler; /* smc1 */ |
| _ramvec[vba+CPMVEC_SPI] = inthandler; /* spi */ |
| _ramvec[vba+CPMVEC_PIO_PC9] = inthandler; /* pio - pc9 */ |
| _ramvec[vba+CPMVEC_TIMER4] = inthandler; /* timer 4 */ |
| _ramvec[vba+CPMVEC_RESERVED1] = inthandler; /* reserved */ |
| _ramvec[vba+CPMVEC_PIO_PC8] = inthandler; /* pio - pc8 */ |
| _ramvec[vba+CPMVEC_PIO_PC7] = inthandler; /* pio - pc7 */ |
| _ramvec[vba+CPMVEC_PIO_PC6] = inthandler; /* pio - pc6 */ |
| _ramvec[vba+CPMVEC_TIMER3] = inthandler; /* timer 3 */ |
| _ramvec[vba+CPMVEC_RISCTIMER] = inthandler; /* reserved */ |
| _ramvec[vba+CPMVEC_PIO_PC5] = inthandler; /* pio - pc5 */ |
| _ramvec[vba+CPMVEC_PIO_PC4] = inthandler; /* pio - pc4 */ |
| _ramvec[vba+CPMVEC_RESERVED2] = inthandler; /* reserved */ |
| _ramvec[vba+CPMVEC_RISCTIMER] = inthandler; /* timer table */ |
| _ramvec[vba+CPMVEC_TIMER2] = inthandler; /* timer 2 */ |
| _ramvec[vba+CPMVEC_RESERVED3] = inthandler; /* reserved */ |
| _ramvec[vba+CPMVEC_IDMA2] = inthandler; /* idma 2 */ |
| _ramvec[vba+CPMVEC_IDMA1] = inthandler; /* idma 1 */ |
| _ramvec[vba+CPMVEC_SDMA_CB_ERR] = inthandler; /* sdma channel bus error */ |
| _ramvec[vba+CPMVEC_PIO_PC3] = inthandler; /* pio - pc3 */ |
| _ramvec[vba+CPMVEC_PIO_PC2] = inthandler; /* pio - pc2 */ |
| /* _ramvec[vba+CPMVEC_TIMER1] = cpm_isr_timer1; */ /* timer 1 */ |
| _ramvec[vba+CPMVEC_TIMER1] = inthandler; /* timer 1 */ |
| _ramvec[vba+CPMVEC_PIO_PC1] = inthandler; /* pio - pc1 */ |
| _ramvec[vba+CPMVEC_SCC4] = inthandler; /* scc 4 */ |
| _ramvec[vba+CPMVEC_SCC3] = inthandler; /* scc 3 */ |
| _ramvec[vba+CPMVEC_SCC2] = inthandler; /* scc 2 */ |
| _ramvec[vba+CPMVEC_SCC1] = inthandler; /* scc 1 */ |
| _ramvec[vba+CPMVEC_PIO_PC0] = inthandler; /* pio - pc0 */ |
| |
| |
| /* turn off all CPM interrupts */ |
| pquicc->intr_cimr = 0x00000000; |
| |
| /* initialize handlers */ |
| for (i = 0; i < INTERNAL_IRQS; i++) { |
| int_irq_list[i].handler = NULL; |
| int_irq_list[i].flags = IRQ_FLG_STD; |
| int_irq_list[i].dev_id = NULL; |
| int_irq_list[i].devname = NULL; |
| } |
| } |
| |
| #if 0 |
| void M68360_insert_irq(irq_node_t **list, irq_node_t *node) |
| { |
| unsigned long flags; |
| irq_node_t *cur; |
| |
| if (!node->dev_id) |
| printk(KERN_INFO "%s: Warning: dev_id of %s is zero\n", |
| __FUNCTION__, node->devname); |
| |
| local_irq_save(flags); |
| |
| cur = *list; |
| |
| while (cur) { |
| list = &cur->next; |
| cur = cur->next; |
| } |
| |
| node->next = cur; |
| *list = node; |
| |
| local_irq_restore(flags); |
| } |
| |
| void M68360_delete_irq(irq_node_t **list, void *dev_id) |
| { |
| unsigned long flags; |
| irq_node_t *node; |
| |
| local_irq_save(flags); |
| |
| for (node = *list; node; list = &node->next, node = *list) { |
| if (node->dev_id == dev_id) { |
| *list = node->next; |
| /* Mark it as free. */ |
| node->handler = NULL; |
| local_irq_restore(flags); |
| return; |
| } |
| } |
| local_irq_restore(flags); |
| printk (KERN_INFO "%s: tried to remove invalid irq\n", __FUNCTION__); |
| } |
| #endif |
| |
| int request_irq( |
| unsigned int irq, |
| irqreturn_t (*handler)(int, void *, struct pt_regs *), |
| unsigned long flags, |
| const char *devname, |
| void *dev_id) |
| { |
| int mask = (1<<irq); |
| |
| irq += (CPM_VECTOR_BASE<<4); |
| |
| if (irq >= INTERNAL_IRQS) { |
| printk (KERN_ERR "%s: Unknown IRQ %d from %s\n", __FUNCTION__, irq, devname); |
| return -ENXIO; |
| } |
| |
| if (!(int_irq_list[irq].flags & IRQ_FLG_STD)) { |
| if (int_irq_list[irq].flags & IRQ_FLG_LOCK) { |
| printk(KERN_ERR "%s: IRQ %d from %s is not replaceable\n", |
| __FUNCTION__, irq, int_irq_list[irq].devname); |
| return -EBUSY; |
| } |
| if (flags & IRQ_FLG_REPLACE) { |
| printk(KERN_ERR "%s: %s can't replace IRQ %d from %s\n", |
| __FUNCTION__, devname, irq, int_irq_list[irq].devname); |
| return -EBUSY; |
| } |
| } |
| int_irq_list[irq].handler = handler; |
| int_irq_list[irq].flags = flags; |
| int_irq_list[irq].dev_id = dev_id; |
| int_irq_list[irq].devname = devname; |
| |
| /* enable in the CIMR */ |
| if (!int_irq_ablecount[irq]) |
| pquicc->intr_cimr |= mask; |
| /* *(volatile unsigned long *)0xfffff304 &= ~(1<<irq); */ |
| |
| return 0; |
| } |
| |
| EXPORT_SYMBOL(request_irq); |
| |
| void free_irq(unsigned int irq, void *dev_id) |
| { |
| if (irq >= INTERNAL_IRQS) { |
| printk (KERN_ERR "%s: Unknown IRQ %d\n", __FUNCTION__, irq); |
| return; |
| } |
| |
| if (int_irq_list[irq].dev_id != dev_id) |
| printk(KERN_INFO "%s: removing probably wrong IRQ %d from %s\n", |
| __FUNCTION__, irq, int_irq_list[irq].devname); |
| int_irq_list[irq].handler = NULL; |
| int_irq_list[irq].flags = IRQ_FLG_STD; |
| int_irq_list[irq].dev_id = NULL; |
| int_irq_list[irq].devname = NULL; |
| |
| *(volatile unsigned long *)0xfffff304 |= 1<<irq; |
| } |
| |
| EXPORT_SYMBOL(free_irq); |
| |
| #if 0 |
| /* |
| * Enable/disable a particular machine specific interrupt source. |
| * Note that this may affect other interrupts in case of a shared interrupt. |
| * This function should only be called for a _very_ short time to change some |
| * internal data, that may not be changed by the interrupt at the same time. |
| * int_(enable|disable)_irq calls may also be nested. |
| */ |
| void M68360_enable_irq(unsigned int irq) |
| { |
| if (irq >= INTERNAL_IRQS) { |
| printk(KERN_ERR "%s: Unknown IRQ %d\n", __FUNCTION__, irq); |
| return; |
| } |
| |
| if (--int_irq_ablecount[irq]) |
| return; |
| |
| /* enable the interrupt */ |
| *(volatile unsigned long *)0xfffff304 &= ~(1<<irq); |
| } |
| |
| void M68360_disable_irq(unsigned int irq) |
| { |
| if (irq >= INTERNAL_IRQS) { |
| printk(KERN_ERR "%s: Unknown IRQ %d\n", __FUNCTION__, irq); |
| return; |
| } |
| |
| if (int_irq_ablecount[irq]++) |
| return; |
| |
| /* disable the interrupt */ |
| *(volatile unsigned long *)0xfffff304 |= 1<<irq; |
| } |
| #endif |
| |
| int show_interrupts(struct seq_file *p, void *v) |
| { |
| int i = *(loff_t *) v; |
| |
| if (i < NR_IRQS) { |
| if (int_irq_list[i].devname) { |
| seq_printf(p, "%3d: %10u ", i, kstat_cpu(0).irqs[i]); |
| if (int_irq_list[i].flags & IRQ_FLG_LOCK) |
| seq_printf(p, "L "); |
| else |
| seq_printf(p, " "); |
| seq_printf(p, "%s\n", int_irq_list[i].devname); |
| } |
| } |
| if (i == NR_IRQS) |
| seq_printf(p, " : %10u spurious\n", num_spurious); |
| |
| return 0; |
| } |
| |
| /* The 68k family did not have a good way to determine the source |
| * of interrupts until later in the family. The EC000 core does |
| * not provide the vector number on the stack, we vector everything |
| * into one vector and look in the blasted mask register... |
| * This code is designed to be fast, almost constant time, not clean! |
| */ |
| void process_int(int vec, struct pt_regs *fp) |
| { |
| int irq; |
| int mask; |
| |
| /* unsigned long pend = *(volatile unsigned long *)0xfffff30c; */ |
| |
| /* irq = vec + (CPM_VECTOR_BASE<<4); */ |
| irq = vec; |
| |
| /* unsigned long pend = *(volatile unsigned long *)pquicc->intr_cipr; */ |
| |
| /* Bugger all that weirdness. For the moment, I seem to know where I came from; |
| * vec is passed from a specific ISR, so I'll use it. */ |
| |
| if (int_irq_list[irq].handler) { |
| int_irq_list[irq].handler(irq , int_irq_list[irq].dev_id, fp); |
| kstat_cpu(0).irqs[irq]++; |
| pquicc->intr_cisr = (1 << vec); /* indicate that irq has been serviced */ |
| } else { |
| printk(KERN_ERR "unregistered interrupt %d!\nTurning it off in the CIMR...\n", irq); |
| /* *(volatile unsigned long *)0xfffff304 |= mask; */ |
| pquicc->intr_cimr &= ~(1 << vec); |
| num_spurious += 1; |
| } |
| return(IRQ_HANDLED); |
| } |