/* * Carsten Langgaard, carstenl@mips.com * Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved. * * This program is free software; you can distribute it and/or modify it * under the terms of the GNU General Public License (Version 2) as * published by the Free Software Foundation. * * This program is distributed in the hope it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License * for more details. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA. * * Routines for generic manipulation of the interrupts found on the * Lasat boards. */ #include <linux/init.h> #include <linux/sched.h> #include <linux/slab.h> #include <linux/interrupt.h> #include <linux/kernel_stat.h> #include <asm/bootinfo.h> #include <asm/irq.h> #include <asm/lasat/lasatint.h> #include <asm/gdb-stub.h> static volatile int *lasat_int_status = NULL; static volatile int *lasat_int_mask = NULL; static volatile int lasat_int_mask_shift; extern asmlinkage void lasatIRQ(void); void disable_lasat_irq(unsigned int irq_nr) { unsigned long flags; local_irq_save(flags); *lasat_int_mask &= ~(1 << irq_nr) << lasat_int_mask_shift; local_irq_restore(flags); } void enable_lasat_irq(unsigned int irq_nr) { unsigned long flags; local_irq_save(flags); *lasat_int_mask |= (1 << irq_nr) << lasat_int_mask_shift; local_irq_restore(flags); } static unsigned int startup_lasat_irq(unsigned int irq) { enable_lasat_irq(irq); return 0; /* never anything pending */ } #define shutdown_lasat_irq disable_lasat_irq #define mask_and_ack_lasat_irq disable_lasat_irq static void end_lasat_irq(unsigned int irq) { if (!(irq_desc[irq].status & (IRQ_DISABLED|IRQ_INPROGRESS))) enable_lasat_irq(irq); } static struct hw_interrupt_type lasat_irq_type = { "Lasat", startup_lasat_irq, shutdown_lasat_irq, enable_lasat_irq, disable_lasat_irq, mask_and_ack_lasat_irq, end_lasat_irq, NULL }; static inline int ls1bit32(unsigned int x) { int b = 31, s; s = 16; if (x << 16 == 0) s = 0; b -= s; x <<= s; s = 8; if (x << 8 == 0) s = 0; b -= s; x <<= s; s = 4; if (x << 4 == 0) s = 0; b -= s; x <<= s; s = 2; if (x << 2 == 0) s = 0; b -= s; x <<= s; s = 1; if (x << 1 == 0) s = 0; b -= s; return b; } static unsigned long (* get_int_status)(void); static unsigned long get_int_status_100(void) { return *lasat_int_status & *lasat_int_mask; } static unsigned long get_int_status_200(void) { unsigned long int_status; int_status = *lasat_int_status; int_status &= (int_status >> LASATINT_MASK_SHIFT_200) & 0xffff; return int_status; } void lasat_hw0_irqdispatch(struct pt_regs *regs) { unsigned long int_status; int irq; int_status = get_int_status(); /* if int_status == 0, then the interrupt has already been cleared */ if (int_status) { irq = ls1bit32(int_status); do_IRQ(irq, regs); } } void __init arch_init_irq(void) { int i; switch (mips_machtype) { case MACH_LASAT_100: lasat_int_status = (void *)LASAT_INT_STATUS_REG_100; lasat_int_mask = (void *)LASAT_INT_MASK_REG_100; lasat_int_mask_shift = LASATINT_MASK_SHIFT_100; get_int_status = get_int_status_100; *lasat_int_mask = 0; break; case MACH_LASAT_200: lasat_int_status = (void *)LASAT_INT_STATUS_REG_200; lasat_int_mask = (void *)LASAT_INT_MASK_REG_200; lasat_int_mask_shift = LASATINT_MASK_SHIFT_200; get_int_status = get_int_status_200; *lasat_int_mask &= 0xffff; break; default: panic("arch_init_irq: mips_machtype incorrect"); } /* Now safe to set the exception vector. */ set_except_vector(0, lasatIRQ); for (i = 0; i <= LASATINT_END; i++) { irq_desc[i].status = IRQ_DISABLED; irq_desc[i].action = 0; irq_desc[i].depth = 1; irq_desc[i].handler = &lasat_irq_type; } }