1 /* 2 * Copyright (C) 2004 Florian Schirmer <jolt@tuxbox.org> 3 * 4 * This program is free software; you can redistribute it and/or modify it 5 * under the terms of the GNU General Public License as published by the 6 * Free Software Foundation; either version 2 of the License, or (at your 7 * option) any later version. 8 * 9 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED 10 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 11 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN 12 * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 13 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 14 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF 15 * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON 16 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 17 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 18 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 19 * 20 * You should have received a copy of the GNU General Public License along 21 * with this program; if not, write to the Free Software Foundation, Inc., 22 * 675 Mass Ave, Cambridge, MA 02139, USA. 23 */ 24 25 #include "bcm47xx_private.h" 26 27 #include <linux/types.h> 28 #include <linux/interrupt.h> 29 #include <linux/irq.h> 30 #include <asm/setup.h> 31 #include <asm/irq_cpu.h> 32 #include <bcm47xx.h> 33 34 asmlinkage void plat_irq_dispatch(void) 35 { 36 u32 cause; 37 38 cause = read_c0_cause() & read_c0_status() & CAUSEF_IP; 39 40 clear_c0_status(cause); 41 42 if (cause & CAUSEF_IP7) 43 do_IRQ(7); 44 if (cause & CAUSEF_IP2) 45 do_IRQ(2); 46 if (cause & CAUSEF_IP3) 47 do_IRQ(3); 48 if (cause & CAUSEF_IP4) 49 do_IRQ(4); 50 if (cause & CAUSEF_IP5) 51 do_IRQ(5); 52 if (cause & CAUSEF_IP6) 53 do_IRQ(6); 54 } 55 56 #define DEFINE_HWx_IRQDISPATCH(x) \ 57 static void bcm47xx_hw ## x ## _irqdispatch(void) \ 58 { \ 59 do_IRQ(x); \ 60 } 61 DEFINE_HWx_IRQDISPATCH(2) 62 DEFINE_HWx_IRQDISPATCH(3) 63 DEFINE_HWx_IRQDISPATCH(4) 64 DEFINE_HWx_IRQDISPATCH(5) 65 DEFINE_HWx_IRQDISPATCH(6) 66 DEFINE_HWx_IRQDISPATCH(7) 67 68 void __init arch_init_irq(void) 69 { 70 /* 71 * This is the first arch callback after mm_init (we can use kmalloc), 72 * so let's finish bus initialization now. 73 */ 74 bcm47xx_bus_setup(); 75 76 #ifdef CONFIG_BCM47XX_BCMA 77 if (bcm47xx_bus_type == BCM47XX_BUS_TYPE_BCMA) { 78 bcma_write32(bcm47xx_bus.bcma.bus.drv_mips.core, 79 BCMA_MIPS_MIPS74K_INTMASK(5), 1 << 31); 80 /* 81 * the kernel reads the timer irq from some register and thinks 82 * it's #5, but we offset it by 2 and route to #7 83 */ 84 cp0_compare_irq = 7; 85 } 86 #endif 87 mips_cpu_irq_init(); 88 89 if (cpu_has_vint) { 90 pr_info("Setting up vectored interrupts\n"); 91 set_vi_handler(2, bcm47xx_hw2_irqdispatch); 92 set_vi_handler(3, bcm47xx_hw3_irqdispatch); 93 set_vi_handler(4, bcm47xx_hw4_irqdispatch); 94 set_vi_handler(5, bcm47xx_hw5_irqdispatch); 95 set_vi_handler(6, bcm47xx_hw6_irqdispatch); 96 set_vi_handler(7, bcm47xx_hw7_irqdispatch); 97 } 98 } 99