sh: Convert INTC2 to IRQ table registration.
[linux-2.6.git] / 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 }