[ARM] fix pxa
[linux-2.6] / arch / arm / mach-lh7a40x / irq-lh7a404.c
1 /* arch/arm/mach-lh7a40x/irq-lh7a404.c
2  *
3  *  Copyright (C) 2004 Logic Product Development
4  *
5  *  This program is free software; you can redistribute it and/or
6  *  modify it under the terms of the GNU General Public License
7  *  version 2 as published by the Free Software Foundation.
8  *
9  */
10
11 #include <linux/init.h>
12 #include <linux/module.h>
13 #include <linux/interrupt.h>
14
15 #include <mach/hardware.h>
16 #include <asm/irq.h>
17 #include <asm/mach/irq.h>
18 #include <mach/irqs.h>
19
20 #include "common.h"
21
22 #define USE_PRIORITIES
23
24 /* See Documentation/arm/Sharp-LH/VectoredInterruptController for more
25  * information on using the vectored interrupt controller's
26  * prioritizing feature. */
27
28 static unsigned char irq_pri_vic1[] = {
29 #if defined (USE_PRIORITIES)
30         IRQ_GPIO3INTR,                  /* CPLD */
31         IRQ_DMAM2P4, IRQ_DMAM2P5,       /* AC97 */
32 #endif
33 };
34 static unsigned char irq_pri_vic2[] = {
35 #if defined (USE_PRIORITIES)
36         IRQ_T3UI,                       /* Timer */
37         IRQ_GPIO7INTR,                  /* CPLD */
38         IRQ_UART1INTR, IRQ_UART2INTR, IRQ_UART3INTR,
39         IRQ_LCDINTR,                    /* LCD */
40         IRQ_TSCINTR,                    /* ADC/Touchscreen */
41 #endif
42 };
43
44   /* CPU IRQ handling */
45
46 static void lh7a404_vic1_mask_irq (u32 irq)
47 {
48         VIC1_INTENCLR = (1 << irq);
49 }
50
51 static void lh7a404_vic1_unmask_irq (u32 irq)
52 {
53         VIC1_INTEN = (1 << irq);
54 }
55
56 static void lh7a404_vic2_mask_irq (u32 irq)
57 {
58         VIC2_INTENCLR = (1 << (irq - 32));
59 }
60
61 static void lh7a404_vic2_unmask_irq (u32 irq)
62 {
63         VIC2_INTEN = (1 << (irq - 32));
64 }
65
66 static void lh7a404_vic1_ack_gpio_irq (u32 irq)
67 {
68         GPIO_GPIOFEOI = (1 << IRQ_TO_GPIO (irq));
69         VIC1_INTENCLR = (1 << irq);
70 }
71
72 static void lh7a404_vic2_ack_gpio_irq (u32 irq)
73 {
74         GPIO_GPIOFEOI = (1 << IRQ_TO_GPIO (irq));
75         VIC2_INTENCLR = (1 << irq);
76 }
77
78 static struct irq_chip lh7a404_vic1_chip = {
79         .name   = "VIC1",
80         .ack    = lh7a404_vic1_mask_irq, /* Because level-triggered */
81         .mask   = lh7a404_vic1_mask_irq,
82         .unmask = lh7a404_vic1_unmask_irq,
83 };
84
85 static struct irq_chip lh7a404_vic2_chip = {
86         .name   = "VIC2",
87         .ack    = lh7a404_vic2_mask_irq, /* Because level-triggered */
88         .mask   = lh7a404_vic2_mask_irq,
89         .unmask = lh7a404_vic2_unmask_irq,
90 };
91
92 static struct irq_chip lh7a404_gpio_vic1_chip = {
93         .name   = "GPIO-VIC1",
94         .ack    = lh7a404_vic1_ack_gpio_irq,
95         .mask   = lh7a404_vic1_mask_irq,
96         .unmask = lh7a404_vic1_unmask_irq,
97 };
98
99 static struct irq_chip lh7a404_gpio_vic2_chip = {
100         .name   = "GPIO-VIC2",
101         .ack    = lh7a404_vic2_ack_gpio_irq,
102         .mask   = lh7a404_vic2_mask_irq,
103         .unmask = lh7a404_vic2_unmask_irq,
104 };
105
106   /* IRQ initialization */
107
108 #if defined (CONFIG_ARCH_LH7A400) && defined (CONFIG_ARCH_LH7A404)
109 extern void* branch_irq_lh7a400;
110 #endif
111
112 void __init lh7a404_init_irq (void)
113 {
114         int irq;
115
116 #if defined (CONFIG_ARCH_LH7A400) && defined (CONFIG_ARCH_LH7A404)
117 #define NOP 0xe1a00000                  /* mov r0, r0 */
118         branch_irq_lh7a400 = NOP;
119 #endif
120
121         VIC1_INTENCLR = 0xffffffff;
122         VIC2_INTENCLR = 0xffffffff;
123         VIC1_INTSEL = 0;                /* All IRQs */
124         VIC2_INTSEL = 0;                /* All IRQs */
125         VIC1_NVADDR = VA_VIC1DEFAULT;
126         VIC2_NVADDR = VA_VIC2DEFAULT;
127         VIC1_VECTADDR = 0;
128         VIC2_VECTADDR = 0;
129
130         GPIO_GPIOFINTEN = 0x00;         /* Disable all GPIOF interrupts */
131         barrier ();
132
133                 /* Install prioritized interrupts, if there are any. */
134                 /* The | 0x20*/
135         for (irq = 0; irq < 16; ++irq) {
136                 (&VIC1_VAD0)[irq]
137                         = (irq < ARRAY_SIZE (irq_pri_vic1))
138                         ? (irq_pri_vic1[irq] | VA_VECTORED) : 0;
139                 (&VIC1_VECTCNTL0)[irq]
140                         = (irq < ARRAY_SIZE (irq_pri_vic1))
141                         ? (irq_pri_vic1[irq] | VIC_CNTL_ENABLE) : 0;
142                 (&VIC2_VAD0)[irq]
143                         = (irq < ARRAY_SIZE (irq_pri_vic2))
144                         ? (irq_pri_vic2[irq] | VA_VECTORED) : 0;
145                 (&VIC2_VECTCNTL0)[irq]
146                         = (irq < ARRAY_SIZE (irq_pri_vic2))
147                         ? (irq_pri_vic2[irq] | VIC_CNTL_ENABLE) : 0;
148         }
149
150         for (irq = 0; irq < NR_IRQS; ++irq) {
151                 switch (irq) {
152                 case IRQ_GPIO0INTR:
153                 case IRQ_GPIO1INTR:
154                 case IRQ_GPIO2INTR:
155                 case IRQ_GPIO3INTR:
156                 case IRQ_GPIO4INTR:
157                 case IRQ_GPIO5INTR:
158                 case IRQ_GPIO6INTR:
159                 case IRQ_GPIO7INTR:
160                         set_irq_chip (irq, irq < 32
161                                       ? &lh7a404_gpio_vic1_chip
162                                       : &lh7a404_gpio_vic2_chip);
163                         set_irq_handler (irq, handle_level_irq); /* OK default */
164                         break;
165                 default:
166                         set_irq_chip (irq, irq < 32
167                                       ? &lh7a404_vic1_chip
168                                       : &lh7a404_vic2_chip);
169                         set_irq_handler (irq, handle_level_irq);
170                 }
171                 set_irq_flags (irq, IRQF_VALID);
172         }
173
174         lh7a40x_init_board_irq ();
175 }