Logo Search packages:      
Sourcecode: linux version File versions  Download package

irq.c

/* -------------------------------------------------------------------- */
/* setup_voyagergx.c:                                                     */
/* -------------------------------------------------------------------- */
/*  This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation; either version 2 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that 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., 675 Mass Ave, Cambridge, MA 02139, USA.

    Copyright 2003 (c) Lineo uSolutions,Inc.
*/
#include <linux/interrupt.h>
#include <linux/init.h>
#include <linux/io.h>
#include <asm/voyagergx.h>
#include <asm/rts7751r2d.h>

enum {
      UNUSED = 0,

      /* voyager specific interrupt sources */
      UP, G54, G53, G52, G51, G50, G49, G48,
      I2C, PW, DMA, PCI, I2S, AC, US,
      U1, U0, CV, MC, S1, S0,
      UH, TWOD, ZD, PV, CI,
};

static struct intc_vect vectors[] __initdata = {
      INTC_IRQ(UP, IRQ_SM501_UP), INTC_IRQ(G54, IRQ_SM501_G54),
      INTC_IRQ(G53, IRQ_SM501_G53), INTC_IRQ(G52, IRQ_SM501_G52),
      INTC_IRQ(G51, IRQ_SM501_G51), INTC_IRQ(G50, IRQ_SM501_G50),
      INTC_IRQ(G49, IRQ_SM501_G49), INTC_IRQ(G48, IRQ_SM501_G48),
      INTC_IRQ(I2C, IRQ_SM501_I2C), INTC_IRQ(PW, IRQ_SM501_PW),
      INTC_IRQ(DMA, IRQ_SM501_DMA), INTC_IRQ(PCI, IRQ_SM501_PCI),
      INTC_IRQ(I2S, IRQ_SM501_I2S), INTC_IRQ(AC, IRQ_SM501_AC),
      INTC_IRQ(US, IRQ_SM501_US), INTC_IRQ(U1, IRQ_SM501_U1),
      INTC_IRQ(U0, IRQ_SM501_U0), INTC_IRQ(CV, IRQ_SM501_CV),
      INTC_IRQ(MC, IRQ_SM501_MC), INTC_IRQ(S1, IRQ_SM501_S1),
      INTC_IRQ(S0, IRQ_SM501_S0), INTC_IRQ(UH, IRQ_SM501_UH),
      INTC_IRQ(TWOD, IRQ_SM501_2D), INTC_IRQ(ZD, IRQ_SM501_ZD),
      INTC_IRQ(PV, IRQ_SM501_PV), INTC_IRQ(CI, IRQ_SM501_CI),
};

static struct intc_mask_reg mask_registers[] __initdata = {
      { VOYAGER_INT_MASK, 0, 32, /* "Interrupt Mask", MMIO_base + 0x30 */
        { UP, G54, G53, G52, G51, G50, G49, G48,
          I2C, PW, 0, DMA, PCI, I2S, AC, US,
          0, 0, U1, U0, CV, MC, S1, S0,
          0, UH, 0, 0, TWOD, ZD, PV, CI } },
};

static DECLARE_INTC_DESC(intc_desc, "voyagergx", vectors,
                   NULL, NULL, mask_registers, NULL, NULL);

static unsigned int voyagergx_stat2irq[32] = {
      IRQ_SM501_CI, IRQ_SM501_PV, IRQ_SM501_ZD, IRQ_SM501_2D,
      0, 0, IRQ_SM501_UH, 0,
      IRQ_SM501_S0, IRQ_SM501_S1, IRQ_SM501_MC, IRQ_SM501_CV,
      IRQ_SM501_U0, IRQ_SM501_U1, 0, 0,
      IRQ_SM501_US, IRQ_SM501_AC, IRQ_SM501_I2S, IRQ_SM501_PCI,
      IRQ_SM501_DMA, 0, IRQ_SM501_PW, IRQ_SM501_I2C,
      IRQ_SM501_G48, IRQ_SM501_G49, IRQ_SM501_G50, IRQ_SM501_G51,
      IRQ_SM501_G52, IRQ_SM501_G53, IRQ_SM501_G54, IRQ_SM501_UP
};

static void voyagergx_irq_demux(unsigned int irq, struct irq_desc *desc)
{
      unsigned long intv = ctrl_inl(INT_STATUS);
      struct irq_desc *ext_desc;
      unsigned int ext_irq;
      unsigned int k = 0;

      while (intv) {
            ext_irq = voyagergx_stat2irq[k];
            if (ext_irq && (intv & 1)) {
                  ext_desc = irq_desc + ext_irq;
                  handle_level_irq(ext_irq, ext_desc);
            }
            intv >>= 1;
            k++;
      }
}

void __init setup_voyagergx_irq(void)
{
      printk(KERN_INFO "VoyagerGX on irq %d (mapped into %d to %d)\n",
             IRQ_VOYAGER,
             VOYAGER_IRQ_BASE,
             VOYAGER_IRQ_BASE + VOYAGER_IRQ_NUM - 1);

      register_intc_controller(&intc_desc);
      set_irq_chained_handler(IRQ_VOYAGER, voyagergx_irq_demux);
}

Generated by  Doxygen 1.6.0   Back to index