git.oblomov.eu Git - linux-2.6/blob - arch/mips/emma2rh/common/irq.c

   1 /*
   2  *  arch/mips/emma2rh/common/irq.c
   3  *      This file is common irq dispatcher.
   4  *
   5  *  Copyright (C) NEC Electronics Corporation 2005-2006
   6  *
   7  *  This file is based on the arch/mips/ddb5xxx/ddb5477/irq.c
   8  *
   9  *      Copyright 2001 MontaVista Software Inc.
  10  *
  11  *  This program is free software; you can redistribute it and/or modify
  12  *  it under the terms of the GNU General Public License as published by
  13  *  the Free Software Foundation; either version 2 of the License, or
  14  *  (at your option) any later version.
  15  *
  16  *  This program is distributed in the hope that it will be useful,
  17  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  18  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  19  *  GNU General Public License for more details.
  20  *
  21  *  You should have received a copy of the GNU General Public License
  22  *  along with this program; if not, write to the Free Software
  23  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  24  */
  25 #include <linux/config.h>
  26 #include <linux/init.h>
  27 #include <linux/interrupt.h>
  28 #include <linux/irq.h>
  29 #include <linux/types.h>
  30
  31 #include <asm/i8259.h>
  32 #include <asm/system.h>
  33 #include <asm/mipsregs.h>
  34 #include <asm/debug.h>
  35 #include <asm/addrspace.h>
  36 #include <asm/bootinfo.h>
  37
  38 #include <asm/emma2rh/emma2rh.h>
  39
  40 /*
  41  * the first level int-handler will jump here if it is a emma2rh irq
  42  */
  43 asmlinkage void emma2rh_irq_dispatch(struct pt_regs *regs)
  44 {
  45         u32 intStatus;
  46         u32 bitmask;
  47         u32 i;
  48
  49         intStatus = emma2rh_in32(EMMA2RH_BHIF_INT_ST_0)
  50             & emma2rh_in32(EMMA2RH_BHIF_INT_EN_0);
  51
  52 #ifdef EMMA2RH_SW_CASCADE
  53         if (intStatus &
  54             (1 << ((EMMA2RH_SW_CASCADE - EMMA2RH_IRQ_INT0) & (32 - 1)))) {
  55                 u32 swIntStatus;
  56                 swIntStatus = emma2rh_in32(EMMA2RH_BHIF_SW_INT)
  57                     & emma2rh_in32(EMMA2RH_BHIF_SW_INT_EN);
  58                 for (i = 0, bitmask = 1; i < 32; i++, bitmask <<= 1) {
  59                         if (swIntStatus & bitmask) {
  60                                 do_IRQ(EMMA2RH_SW_IRQ_BASE + i, regs);
  61                                 return;
  62                         }
  63                 }
  64         }
  65 #endif
  66
  67         for (i = 0, bitmask = 1; i < 32; i++, bitmask <<= 1) {
  68                 if (intStatus & bitmask) {
  69                         do_IRQ(EMMA2RH_IRQ_BASE + i, regs);
  70                         return;
  71                 }
  72         }
  73
  74         intStatus = emma2rh_in32(EMMA2RH_BHIF_INT_ST_1)
  75             & emma2rh_in32(EMMA2RH_BHIF_INT_EN_1);
  76
  77 #ifdef EMMA2RH_GPIO_CASCADE
  78         if (intStatus &
  79             (1 << ((EMMA2RH_GPIO_CASCADE - EMMA2RH_IRQ_INT0) & (32 - 1)))) {
  80                 u32 gpioIntStatus;
  81                 gpioIntStatus = emma2rh_in32(EMMA2RH_GPIO_INT_ST)
  82                     & emma2rh_in32(EMMA2RH_GPIO_INT_MASK);
  83                 for (i = 0, bitmask = 1; i < 32; i++, bitmask <<= 1) {
  84                         if (gpioIntStatus & bitmask) {
  85                                 do_IRQ(EMMA2RH_GPIO_IRQ_BASE + i, regs);
  86                                 return;
  87                         }
  88                 }
  89         }
  90 #endif
  91
  92         for (i = 32, bitmask = 1; i < 64; i++, bitmask <<= 1) {
  93                 if (intStatus & bitmask) {
  94                         do_IRQ(EMMA2RH_IRQ_BASE + i, regs);
  95                         return;
  96                 }
  97         }
  98
  99         intStatus = emma2rh_in32(EMMA2RH_BHIF_INT_ST_2)
 100             & emma2rh_in32(EMMA2RH_BHIF_INT_EN_2);
 101
 102         for (i = 64, bitmask = 1; i < 96; i++, bitmask <<= 1) {
 103                 if (intStatus & bitmask) {
 104                         do_IRQ(EMMA2RH_IRQ_BASE + i, regs);
 105                         return;
 106                 }
 107         }
 108 }