git.oblomov.eu Git - linux-2.6/blob - arch/sh/kernel/cpu/irq/intc2.c

   1 /*
   2  * Interrupt handling for INTC2-based IRQ.
   3  *
   4  * Copyright (C) 2001 David J. Mckay (david.mckay@st.com)
   5  * Copyright (C) 2005, 2006 Paul Mundt (lethal@linux-sh.org)
   6  *
   7  * May be copied or modified under the terms of the GNU General Public
   8  * License.  See linux/COPYING for more information.
   9  *
  10  * These are the "new Hitachi style" interrupts, as present on the
  11  * Hitachi 7751, the STM ST40 STB1, SH7760, and SH7780.
  12  */
  13 #include <linux/kernel.h>
  14 #include <linux/interrupt.h>
  15 #include <linux/io.h>
  16
  17 #if defined(CONFIG_CPU_SUBTYPE_SH7760)
  18 #define INTC2_BASE      0xfe080000
  19 #define INTC2_INTMSK    (INTC2_BASE + 0x40)
  20 #define INTC2_INTMSKCLR (INTC2_BASE + 0x60)
  21 #elif defined(CONFIG_CPU_SUBTYPE_SH7780)
  22 #define INTC2_BASE      0xffd40000
  23 #define INTC2_INTMSK    (INTC2_BASE + 0x38)
  24 #define INTC2_INTMSKCLR (INTC2_BASE + 0x3c)
  25 #endif
  26
  27 static void disable_intc2_irq(unsigned int irq)
  28 {
  29         struct intc2_data *p = get_irq_chip_data(irq);
  30         ctrl_outl(1 << p->msk_shift, INTC2_INTMSK + p->msk_offset);
  31 }
  32
  33 static void enable_intc2_irq(unsigned int irq)
  34 {
  35         struct intc2_data *p = get_irq_chip_data(irq);
  36         ctrl_outl(1 << p->msk_shift, INTC2_INTMSKCLR + p->msk_offset);
  37 }
  38
  39 static struct irq_chip intc2_irq_chip = {
  40         .name           = "INTC2",
  41         .mask           = disable_intc2_irq,
  42         .unmask         = enable_intc2_irq,
  43         .mask_ack       = disable_intc2_irq,
  44 };
  45
  46 /*
  47  * Setup an INTC2 style interrupt.
  48  * NOTE: Unlike IPR interrupts, parameters are not shifted by this code,
  49  * allowing the use of the numbers straight out of the datasheet.
  50  * For example:
  51  *    PIO1 which is INTPRI00[19,16] and INTMSK00[13]
  52  * would be:               ^     ^             ^  ^
  53  *                         |     |             |  |
  54  *     { 84,               0,   16,            0, 13 },
  55  *
  56  * in the intc2_data table.
  57  */
  58 void make_intc2_irq(struct intc2_data *table, unsigned int nr_irqs)
  59 {
  60         int i;
  61
  62         for (i = 0; i < nr_irqs; i++) {
  63                 unsigned long ipr, flags;
  64                 struct intc2_data *p = table + i;
  65
  66                 disable_irq_nosync(p->irq);
  67
  68                 /* Set the priority level */
  69                 local_irq_save(flags);
  70
  71                 ipr = ctrl_inl(INTC2_BASE + p->ipr_offset);
  72                 ipr &= ~(0xf << p->ipr_shift);
  73                 ipr |= p->priority << p->ipr_shift;
  74                 ctrl_outl(ipr, INTC2_BASE + p->ipr_offset);
  75
  76                 local_irq_restore(flags);
  77
  78                 set_irq_chip_and_handler_name(p->irq, &intc2_irq_chip,
  79                                               handle_level_irq, "level");
  80                 set_irq_chip_data(p->irq, p);
  81
  82                 enable_intc2_irq(p->irq);
  83         }
  84 }