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/irq.h>
  15 #include <linux/io.h>
  16 #include <asm/system.h>
  17
  18 static void disable_intc2_irq(unsigned int irq)
  19 {
  20         struct intc2_data *p = get_irq_chip_data(irq);
  21         ctrl_outl(1 << p->msk_shift,
  22                   INTC2_BASE + INTC2_INTMSK_OFFSET + p->msk_offset);
  23 }
  24
  25 static void enable_intc2_irq(unsigned int irq)
  26 {
  27         struct intc2_data *p = get_irq_chip_data(irq);
  28         ctrl_outl(1 << p->msk_shift,
  29                   INTC2_BASE + INTC2_INTMSKCLR_OFFSET + p->msk_offset);
  30 }
  31
  32 static struct irq_chip intc2_irq_chip = {
  33         .name           = "INTC2",
  34         .mask           = disable_intc2_irq,
  35         .unmask         = enable_intc2_irq,
  36         .mask_ack       = disable_intc2_irq,
  37 };
  38
  39 /*
  40  * Setup an INTC2 style interrupt.
  41  * NOTE: Unlike IPR interrupts, parameters are not shifted by this code,
  42  * allowing the use of the numbers straight out of the datasheet.
  43  * For example:
  44  *    PIO1 which is INTPRI00[19,16] and INTMSK00[13]
  45  * would be:               ^     ^             ^  ^
  46  *                         |     |             |  |
  47  *     { 84,               0,   16,            0, 13 },
  48  *
  49  * in the intc2_data table.
  50  */
  51 void make_intc2_irq(struct intc2_data *table, unsigned int nr_irqs)
  52 {
  53         int i;
  54
  55         for (i = 0; i < nr_irqs; i++) {
  56                 unsigned long ipr, flags;
  57                 struct intc2_data *p = table + i;
  58
  59                 disable_irq_nosync(p->irq);
  60
  61                 /* Set the priority level */
  62                 local_irq_save(flags);
  63
  64                 ipr = ctrl_inl(INTC2_BASE + INTC2_INTPRI_OFFSET +
  65                                p->ipr_offset);
  66                 ipr &= ~(0xf << p->ipr_shift);
  67                 ipr |= p->priority << p->ipr_shift;
  68                 ctrl_outl(ipr, INTC2_BASE + INTC2_INTPRI_OFFSET +
  69                           p->ipr_offset);
  70
  71                 local_irq_restore(flags);
  72
  73                 set_irq_chip_and_handler_name(p->irq, &intc2_irq_chip,
  74                                               handle_level_irq, "level");
  75                 set_irq_chip_data(p->irq, p);
  76
  77                 enable_intc2_irq(p->irq);
  78         }
  79 }