diff options
author | Ralf Baechle <ralf@linux-mips.org> | 2007-10-17 05:58:43 -0400 |
---|---|---|
committer | Ralf Baechle <ralf@linux-mips.org> | 2007-10-17 13:28:48 -0400 |
commit | f3e8d1da389fe2e514e31f6e93c690c8e1243849 (patch) | |
tree | 75ed85948d11f14c1ea6f483333a365af588955c /arch/mips/au1000 | |
parent | fb8dd014220f51dadcbfb91e6d1dfca69d0910a7 (diff) |
[MIPS] Alchemy: Fix build by conversion to irq_cpu.c.
Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
Diffstat (limited to 'arch/mips/au1000')
-rw-r--r-- | arch/mips/au1000/Kconfig | 1 | ||||
-rw-r--r-- | arch/mips/au1000/common/irq.c | 251 |
2 files changed, 133 insertions, 119 deletions
diff --git a/arch/mips/au1000/Kconfig b/arch/mips/au1000/Kconfig index 29c95d97217d..a23d4154da01 100644 --- a/arch/mips/au1000/Kconfig +++ b/arch/mips/au1000/Kconfig | |||
@@ -137,6 +137,7 @@ config SOC_AU1200 | |||
137 | config SOC_AU1X00 | 137 | config SOC_AU1X00 |
138 | bool | 138 | bool |
139 | select 64BIT_PHYS_ADDR | 139 | select 64BIT_PHYS_ADDR |
140 | select IRQ_CPU | ||
140 | select SYS_HAS_CPU_MIPS32_R1 | 141 | select SYS_HAS_CPU_MIPS32_R1 |
141 | select SYS_SUPPORTS_32BIT_KERNEL | 142 | select SYS_SUPPORTS_32BIT_KERNEL |
142 | select SYS_SUPPORTS_APM_EMULATION | 143 | select SYS_SUPPORTS_APM_EMULATION |
diff --git a/arch/mips/au1000/common/irq.c b/arch/mips/au1000/common/irq.c index c00f308fd505..59e932a928d2 100644 --- a/arch/mips/au1000/common/irq.c +++ b/arch/mips/au1000/common/irq.c | |||
@@ -1,11 +1,10 @@ | |||
1 | /* | 1 | /* |
2 | * BRIEF MODULE DESCRIPTION | ||
3 | * Au1000 interrupt routines. | ||
4 | * | ||
5 | * Copyright 2001 MontaVista Software Inc. | 2 | * Copyright 2001 MontaVista Software Inc. |
6 | * Author: MontaVista Software, Inc. | 3 | * Author: MontaVista Software, Inc. |
7 | * ppopov@mvista.com or source@mvista.com | 4 | * ppopov@mvista.com or source@mvista.com |
8 | * | 5 | * |
6 | * Copyright (C) 2007 Ralf Baechle (ralf@linux-mips.org) | ||
7 | * | ||
9 | * This program is free software; you can redistribute it and/or modify it | 8 | * This program is free software; you can redistribute it and/or modify it |
10 | * under the terms of the GNU General Public License as published by the | 9 | * under the terms of the GNU General Public License as published by the |
11 | * Free Software Foundation; either version 2 of the License, or (at your | 10 | * Free Software Foundation; either version 2 of the License, or (at your |
@@ -32,6 +31,7 @@ | |||
32 | #include <linux/interrupt.h> | 31 | #include <linux/interrupt.h> |
33 | #include <linux/irq.h> | 32 | #include <linux/irq.h> |
34 | 33 | ||
34 | #include <asm/irq_cpu.h> | ||
35 | #include <asm/mipsregs.h> | 35 | #include <asm/mipsregs.h> |
36 | #include <asm/mach-au1x00/au1000.h> | 36 | #include <asm/mach-au1x00/au1000.h> |
37 | #ifdef CONFIG_MIPS_PB1000 | 37 | #ifdef CONFIG_MIPS_PB1000 |
@@ -44,7 +44,7 @@ | |||
44 | #define EXT_INTC1_REQ1 5 /* IP 5 */ | 44 | #define EXT_INTC1_REQ1 5 /* IP 5 */ |
45 | #define MIPS_TIMER_IP 7 /* IP 7 */ | 45 | #define MIPS_TIMER_IP 7 /* IP 7 */ |
46 | 46 | ||
47 | void (*board_init_irq)(void); | 47 | void (*board_init_irq)(void) __initdata = NULL; |
48 | 48 | ||
49 | static DEFINE_SPINLOCK(irq_lock); | 49 | static DEFINE_SPINLOCK(irq_lock); |
50 | 50 | ||
@@ -134,12 +134,14 @@ void restore_au1xxx_intctl(void) | |||
134 | 134 | ||
135 | inline void local_enable_irq(unsigned int irq_nr) | 135 | inline void local_enable_irq(unsigned int irq_nr) |
136 | { | 136 | { |
137 | if (irq_nr > AU1000_LAST_INTC0_INT) { | 137 | unsigned int bit = irq_nr - AU1000_INTC0_INT_BASE; |
138 | au_writel(1 << (irq_nr - 32), IC1_MASKSET); | 138 | |
139 | au_writel(1 << (irq_nr - 32), IC1_WAKESET); | 139 | if (bit >= 32) { |
140 | au_writel(1 << (bit - 32), IC1_MASKSET); | ||
141 | au_writel(1 << (bit - 32), IC1_WAKESET); | ||
140 | } else { | 142 | } else { |
141 | au_writel(1 << irq_nr, IC0_MASKSET); | 143 | au_writel(1 << bit, IC0_MASKSET); |
142 | au_writel(1 << irq_nr, IC0_WAKESET); | 144 | au_writel(1 << bit, IC0_WAKESET); |
143 | } | 145 | } |
144 | au_sync(); | 146 | au_sync(); |
145 | } | 147 | } |
@@ -147,12 +149,14 @@ inline void local_enable_irq(unsigned int irq_nr) | |||
147 | 149 | ||
148 | inline void local_disable_irq(unsigned int irq_nr) | 150 | inline void local_disable_irq(unsigned int irq_nr) |
149 | { | 151 | { |
150 | if (irq_nr > AU1000_LAST_INTC0_INT) { | 152 | unsigned int bit = irq_nr - AU1000_INTC0_INT_BASE; |
151 | au_writel(1 << (irq_nr - 32), IC1_MASKCLR); | 153 | |
152 | au_writel(1 << (irq_nr - 32), IC1_WAKECLR); | 154 | if (bit >= 32) { |
155 | au_writel(1 << (bit - 32), IC1_MASKCLR); | ||
156 | au_writel(1 << (bit - 32), IC1_WAKECLR); | ||
153 | } else { | 157 | } else { |
154 | au_writel(1 << irq_nr, IC0_MASKCLR); | 158 | au_writel(1 << bit, IC0_MASKCLR); |
155 | au_writel(1 << irq_nr, IC0_WAKECLR); | 159 | au_writel(1 << bit, IC0_WAKECLR); |
156 | } | 160 | } |
157 | au_sync(); | 161 | au_sync(); |
158 | } | 162 | } |
@@ -160,12 +164,14 @@ inline void local_disable_irq(unsigned int irq_nr) | |||
160 | 164 | ||
161 | static inline void mask_and_ack_rise_edge_irq(unsigned int irq_nr) | 165 | static inline void mask_and_ack_rise_edge_irq(unsigned int irq_nr) |
162 | { | 166 | { |
163 | if (irq_nr > AU1000_LAST_INTC0_INT) { | 167 | unsigned int bit = irq_nr - AU1000_INTC0_INT_BASE; |
164 | au_writel(1 << (irq_nr - 32), IC1_RISINGCLR); | 168 | |
165 | au_writel(1 << (irq_nr - 32), IC1_MASKCLR); | 169 | if (bit >= 32) { |
170 | au_writel(1 << (bit - 32), IC1_RISINGCLR); | ||
171 | au_writel(1 << (bit - 32), IC1_MASKCLR); | ||
166 | } else { | 172 | } else { |
167 | au_writel(1 << irq_nr, IC0_RISINGCLR); | 173 | au_writel(1 << bit, IC0_RISINGCLR); |
168 | au_writel(1 << irq_nr, IC0_MASKCLR); | 174 | au_writel(1 << bit, IC0_MASKCLR); |
169 | } | 175 | } |
170 | au_sync(); | 176 | au_sync(); |
171 | } | 177 | } |
@@ -173,12 +179,14 @@ static inline void mask_and_ack_rise_edge_irq(unsigned int irq_nr) | |||
173 | 179 | ||
174 | static inline void mask_and_ack_fall_edge_irq(unsigned int irq_nr) | 180 | static inline void mask_and_ack_fall_edge_irq(unsigned int irq_nr) |
175 | { | 181 | { |
176 | if (irq_nr > AU1000_LAST_INTC0_INT) { | 182 | unsigned int bit = irq_nr - AU1000_INTC0_INT_BASE; |
177 | au_writel(1 << (irq_nr - 32), IC1_FALLINGCLR); | 183 | |
178 | au_writel(1 << (irq_nr - 32), IC1_MASKCLR); | 184 | if (bit >= 32) { |
185 | au_writel(1 << (bit - 32), IC1_FALLINGCLR); | ||
186 | au_writel(1 << (bit - 32), IC1_MASKCLR); | ||
179 | } else { | 187 | } else { |
180 | au_writel(1 << irq_nr, IC0_FALLINGCLR); | 188 | au_writel(1 << bit, IC0_FALLINGCLR); |
181 | au_writel(1 << irq_nr, IC0_MASKCLR); | 189 | au_writel(1 << bit, IC0_MASKCLR); |
182 | } | 190 | } |
183 | au_sync(); | 191 | au_sync(); |
184 | } | 192 | } |
@@ -186,17 +194,20 @@ static inline void mask_and_ack_fall_edge_irq(unsigned int irq_nr) | |||
186 | 194 | ||
187 | static inline void mask_and_ack_either_edge_irq(unsigned int irq_nr) | 195 | static inline void mask_and_ack_either_edge_irq(unsigned int irq_nr) |
188 | { | 196 | { |
189 | /* This may assume that we don't get interrupts from | 197 | unsigned int bit = irq_nr - AU1000_INTC0_INT_BASE; |
198 | |||
199 | /* | ||
200 | * This may assume that we don't get interrupts from | ||
190 | * both edges at once, or if we do, that we don't care. | 201 | * both edges at once, or if we do, that we don't care. |
191 | */ | 202 | */ |
192 | if (irq_nr > AU1000_LAST_INTC0_INT) { | 203 | if (bit >= 32) { |
193 | au_writel(1 << (irq_nr - 32), IC1_FALLINGCLR); | 204 | au_writel(1 << (bit - 32), IC1_FALLINGCLR); |
194 | au_writel(1 << (irq_nr - 32), IC1_RISINGCLR); | 205 | au_writel(1 << (bit - 32), IC1_RISINGCLR); |
195 | au_writel(1 << (irq_nr - 32), IC1_MASKCLR); | 206 | au_writel(1 << (bit - 32), IC1_MASKCLR); |
196 | } else { | 207 | } else { |
197 | au_writel(1 << irq_nr, IC0_FALLINGCLR); | 208 | au_writel(1 << bit, IC0_FALLINGCLR); |
198 | au_writel(1 << irq_nr, IC0_RISINGCLR); | 209 | au_writel(1 << bit, IC0_RISINGCLR); |
199 | au_writel(1 << irq_nr, IC0_MASKCLR); | 210 | au_writel(1 << bit, IC0_MASKCLR); |
200 | } | 211 | } |
201 | au_sync(); | 212 | au_sync(); |
202 | } | 213 | } |
@@ -213,10 +224,8 @@ static inline void mask_and_ack_level_irq(unsigned int irq_nr) | |||
213 | au_sync(); | 224 | au_sync(); |
214 | } | 225 | } |
215 | #endif | 226 | #endif |
216 | return; | ||
217 | } | 227 | } |
218 | 228 | ||
219 | |||
220 | static void end_irq(unsigned int irq_nr) | 229 | static void end_irq(unsigned int irq_nr) |
221 | { | 230 | { |
222 | if (!(irq_desc[irq_nr].status & (IRQ_DISABLED | IRQ_INPROGRESS))) | 231 | if (!(irq_desc[irq_nr].status & (IRQ_DISABLED | IRQ_INPROGRESS))) |
@@ -341,114 +350,118 @@ void startup_match20_interrupt(irq_handler_t handler) | |||
341 | } | 350 | } |
342 | #endif | 351 | #endif |
343 | 352 | ||
344 | static void setup_local_irq(unsigned int irq_nr, int type, int int_req) | 353 | static void __init setup_local_irq(unsigned int irq_nr, int type, int int_req) |
345 | { | 354 | { |
346 | if (irq_nr > AU1000_MAX_INTR) return; | 355 | unsigned int bit = irq_nr - AU1000_INTC0_INT_BASE; |
356 | |||
357 | if (irq_nr > AU1000_MAX_INTR) | ||
358 | return; | ||
359 | |||
347 | /* Config2[n], Config1[n], Config0[n] */ | 360 | /* Config2[n], Config1[n], Config0[n] */ |
348 | if (irq_nr > AU1000_LAST_INTC0_INT) { | 361 | if (bit >= 32) { |
349 | switch (type) { | 362 | switch (type) { |
350 | case INTC_INT_RISE_EDGE: /* 0:0:1 */ | 363 | case INTC_INT_RISE_EDGE: /* 0:0:1 */ |
351 | au_writel(1 << (irq_nr - 32), IC1_CFG2CLR); | 364 | au_writel(1 << (bit - 32), IC1_CFG2CLR); |
352 | au_writel(1 << (irq_nr - 32), IC1_CFG1CLR); | 365 | au_writel(1 << (bit - 32), IC1_CFG1CLR); |
353 | au_writel(1 << (irq_nr - 32), IC1_CFG0SET); | 366 | au_writel(1 << (bit - 32), IC1_CFG0SET); |
354 | set_irq_chip(irq_nr, &rise_edge_irq_type); | 367 | set_irq_chip(irq_nr, &rise_edge_irq_type); |
355 | break; | 368 | break; |
356 | case INTC_INT_FALL_EDGE: /* 0:1:0 */ | 369 | case INTC_INT_FALL_EDGE: /* 0:1:0 */ |
357 | au_writel(1 << (irq_nr - 32), IC1_CFG2CLR); | 370 | au_writel(1 << (bit - 32), IC1_CFG2CLR); |
358 | au_writel(1 << (irq_nr - 32), IC1_CFG1SET); | 371 | au_writel(1 << (bit - 32), IC1_CFG1SET); |
359 | au_writel(1 << (irq_nr - 32), IC1_CFG0CLR); | 372 | au_writel(1 << (bit - 32), IC1_CFG0CLR); |
360 | set_irq_chip(irq_nr, &fall_edge_irq_type); | 373 | set_irq_chip(irq_nr, &fall_edge_irq_type); |
361 | break; | 374 | break; |
362 | case INTC_INT_RISE_AND_FALL_EDGE: /* 0:1:1 */ | 375 | case INTC_INT_RISE_AND_FALL_EDGE: /* 0:1:1 */ |
363 | au_writel(1 << (irq_nr - 32), IC1_CFG2CLR); | 376 | au_writel(1 << (bit - 32), IC1_CFG2CLR); |
364 | au_writel(1 << (irq_nr - 32), IC1_CFG1SET); | 377 | au_writel(1 << (bit - 32), IC1_CFG1SET); |
365 | au_writel(1 << (irq_nr - 32), IC1_CFG0SET); | 378 | au_writel(1 << (bit - 32), IC1_CFG0SET); |
366 | set_irq_chip(irq_nr, &either_edge_irq_type); | 379 | set_irq_chip(irq_nr, &either_edge_irq_type); |
367 | break; | 380 | break; |
368 | case INTC_INT_HIGH_LEVEL: /* 1:0:1 */ | 381 | case INTC_INT_HIGH_LEVEL: /* 1:0:1 */ |
369 | au_writel(1 << (irq_nr - 32), IC1_CFG2SET); | 382 | au_writel(1 << (bit - 32), IC1_CFG2SET); |
370 | au_writel(1 << (irq_nr - 32), IC1_CFG1CLR); | 383 | au_writel(1 << (bit - 32), IC1_CFG1CLR); |
371 | au_writel(1 << (irq_nr - 32), IC1_CFG0SET); | 384 | au_writel(1 << (bit - 32), IC1_CFG0SET); |
372 | set_irq_chip(irq_nr, &level_irq_type); | 385 | set_irq_chip(irq_nr, &level_irq_type); |
373 | break; | 386 | break; |
374 | case INTC_INT_LOW_LEVEL: /* 1:1:0 */ | 387 | case INTC_INT_LOW_LEVEL: /* 1:1:0 */ |
375 | au_writel(1 << (irq_nr - 32), IC1_CFG2SET); | 388 | au_writel(1 << (bit - 32), IC1_CFG2SET); |
376 | au_writel(1 << (irq_nr - 32), IC1_CFG1SET); | 389 | au_writel(1 << (bit - 32), IC1_CFG1SET); |
377 | au_writel(1 << (irq_nr - 32), IC1_CFG0CLR); | 390 | au_writel(1 << (bit - 32), IC1_CFG0CLR); |
378 | set_irq_chip(irq_nr, &level_irq_type); | 391 | set_irq_chip(irq_nr, &level_irq_type); |
379 | break; | 392 | break; |
380 | case INTC_INT_DISABLED: /* 0:0:0 */ | 393 | case INTC_INT_DISABLED: /* 0:0:0 */ |
381 | au_writel(1 << (irq_nr - 32), IC1_CFG0CLR); | 394 | au_writel(1 << (bit - 32), IC1_CFG0CLR); |
382 | au_writel(1 << (irq_nr - 32), IC1_CFG1CLR); | 395 | au_writel(1 << (bit - 32), IC1_CFG1CLR); |
383 | au_writel(1 << (irq_nr - 32), IC1_CFG2CLR); | 396 | au_writel(1 << (bit - 32), IC1_CFG2CLR); |
384 | break; | 397 | break; |
385 | default: /* disable the interrupt */ | 398 | default: /* disable the interrupt */ |
386 | printk(KERN_WARNING "unexpected int type %d (irq %d)\n", | 399 | printk(KERN_WARNING "unexpected int type %d (irq %d)\n", |
387 | type, irq_nr); | 400 | type, irq_nr); |
388 | au_writel(1 << (irq_nr - 32), IC1_CFG0CLR); | 401 | au_writel(1 << (bit - 32), IC1_CFG0CLR); |
389 | au_writel(1 << (irq_nr - 32), IC1_CFG1CLR); | 402 | au_writel(1 << (bit - 32), IC1_CFG1CLR); |
390 | au_writel(1 << (irq_nr - 32), IC1_CFG2CLR); | 403 | au_writel(1 << (bit - 32), IC1_CFG2CLR); |
391 | return; | 404 | return; |
392 | } | 405 | } |
393 | if (int_req) /* assign to interrupt request 1 */ | 406 | if (int_req) /* assign to interrupt request 1 */ |
394 | au_writel(1 << (irq_nr - 32), IC1_ASSIGNCLR); | 407 | au_writel(1 << (bit - 32), IC1_ASSIGNCLR); |
395 | else /* assign to interrupt request 0 */ | 408 | else /* assign to interrupt request 0 */ |
396 | au_writel(1 << (irq_nr - 32), IC1_ASSIGNSET); | 409 | au_writel(1 << (bit - 32), IC1_ASSIGNSET); |
397 | au_writel(1 << (irq_nr - 32), IC1_SRCSET); | 410 | au_writel(1 << (bit - 32), IC1_SRCSET); |
398 | au_writel(1 << (irq_nr - 32), IC1_MASKCLR); | 411 | au_writel(1 << (bit - 32), IC1_MASKCLR); |
399 | au_writel(1 << (irq_nr - 32), IC1_WAKECLR); | 412 | au_writel(1 << (bit - 32), IC1_WAKECLR); |
400 | } else { | 413 | } else { |
401 | switch (type) { | 414 | switch (type) { |
402 | case INTC_INT_RISE_EDGE: /* 0:0:1 */ | 415 | case INTC_INT_RISE_EDGE: /* 0:0:1 */ |
403 | au_writel(1 << irq_nr, IC0_CFG2CLR); | 416 | au_writel(1 << bit, IC0_CFG2CLR); |
404 | au_writel(1 << irq_nr, IC0_CFG1CLR); | 417 | au_writel(1 << bit, IC0_CFG1CLR); |
405 | au_writel(1 << irq_nr, IC0_CFG0SET); | 418 | au_writel(1 << bit, IC0_CFG0SET); |
406 | set_irq_chip(irq_nr, &rise_edge_irq_type); | 419 | set_irq_chip(irq_nr, &rise_edge_irq_type); |
407 | break; | 420 | break; |
408 | case INTC_INT_FALL_EDGE: /* 0:1:0 */ | 421 | case INTC_INT_FALL_EDGE: /* 0:1:0 */ |
409 | au_writel(1 << irq_nr, IC0_CFG2CLR); | 422 | au_writel(1 << bit, IC0_CFG2CLR); |
410 | au_writel(1 << irq_nr, IC0_CFG1SET); | 423 | au_writel(1 << bit, IC0_CFG1SET); |
411 | au_writel(1 << irq_nr, IC0_CFG0CLR); | 424 | au_writel(1 << bit, IC0_CFG0CLR); |
412 | set_irq_chip(irq_nr, &fall_edge_irq_type); | 425 | set_irq_chip(irq_nr, &fall_edge_irq_type); |
413 | break; | 426 | break; |
414 | case INTC_INT_RISE_AND_FALL_EDGE: /* 0:1:1 */ | 427 | case INTC_INT_RISE_AND_FALL_EDGE: /* 0:1:1 */ |
415 | au_writel(1 << irq_nr, IC0_CFG2CLR); | 428 | au_writel(1 << bit, IC0_CFG2CLR); |
416 | au_writel(1 << irq_nr, IC0_CFG1SET); | 429 | au_writel(1 << bit, IC0_CFG1SET); |
417 | au_writel(1 << irq_nr, IC0_CFG0SET); | 430 | au_writel(1 << bit, IC0_CFG0SET); |
418 | set_irq_chip(irq_nr, &either_edge_irq_type); | 431 | set_irq_chip(irq_nr, &either_edge_irq_type); |
419 | break; | 432 | break; |
420 | case INTC_INT_HIGH_LEVEL: /* 1:0:1 */ | 433 | case INTC_INT_HIGH_LEVEL: /* 1:0:1 */ |
421 | au_writel(1 << irq_nr, IC0_CFG2SET); | 434 | au_writel(1 << bit, IC0_CFG2SET); |
422 | au_writel(1 << irq_nr, IC0_CFG1CLR); | 435 | au_writel(1 << bit, IC0_CFG1CLR); |
423 | au_writel(1 << irq_nr, IC0_CFG0SET); | 436 | au_writel(1 << bit, IC0_CFG0SET); |
424 | set_irq_chip(irq_nr, &level_irq_type); | 437 | set_irq_chip(irq_nr, &level_irq_type); |
425 | break; | 438 | break; |
426 | case INTC_INT_LOW_LEVEL: /* 1:1:0 */ | 439 | case INTC_INT_LOW_LEVEL: /* 1:1:0 */ |
427 | au_writel(1 << irq_nr, IC0_CFG2SET); | 440 | au_writel(1 << bit, IC0_CFG2SET); |
428 | au_writel(1 << irq_nr, IC0_CFG1SET); | 441 | au_writel(1 << bit, IC0_CFG1SET); |
429 | au_writel(1 << irq_nr, IC0_CFG0CLR); | 442 | au_writel(1 << bit, IC0_CFG0CLR); |
430 | set_irq_chip(irq_nr, &level_irq_type); | 443 | set_irq_chip(irq_nr, &level_irq_type); |
431 | break; | 444 | break; |
432 | case INTC_INT_DISABLED: /* 0:0:0 */ | 445 | case INTC_INT_DISABLED: /* 0:0:0 */ |
433 | au_writel(1 << irq_nr, IC0_CFG0CLR); | 446 | au_writel(1 << bit, IC0_CFG0CLR); |
434 | au_writel(1 << irq_nr, IC0_CFG1CLR); | 447 | au_writel(1 << bit, IC0_CFG1CLR); |
435 | au_writel(1 << irq_nr, IC0_CFG2CLR); | 448 | au_writel(1 << bit, IC0_CFG2CLR); |
436 | break; | 449 | break; |
437 | default: /* disable the interrupt */ | 450 | default: /* disable the interrupt */ |
438 | printk(KERN_WARNING "unexpected int type %d (irq %d)\n", | 451 | printk(KERN_WARNING "unexpected int type %d (irq %d)\n", |
439 | type, irq_nr); | 452 | type, irq_nr); |
440 | au_writel(1 << irq_nr, IC0_CFG0CLR); | 453 | au_writel(1 << bit, IC0_CFG0CLR); |
441 | au_writel(1 << irq_nr, IC0_CFG1CLR); | 454 | au_writel(1 << bit, IC0_CFG1CLR); |
442 | au_writel(1 << irq_nr, IC0_CFG2CLR); | 455 | au_writel(1 << bit, IC0_CFG2CLR); |
443 | return; | 456 | return; |
444 | } | 457 | } |
445 | if (int_req) /* assign to interrupt request 1 */ | 458 | if (int_req) /* assign to interrupt request 1 */ |
446 | au_writel(1 << irq_nr, IC0_ASSIGNCLR); | 459 | au_writel(1 << bit, IC0_ASSIGNCLR); |
447 | else /* assign to interrupt request 0 */ | 460 | else /* assign to interrupt request 0 */ |
448 | au_writel(1 << irq_nr, IC0_ASSIGNSET); | 461 | au_writel(1 << bit, IC0_ASSIGNSET); |
449 | au_writel(1 << irq_nr, IC0_SRCSET); | 462 | au_writel(1 << bit, IC0_SRCSET); |
450 | au_writel(1 << irq_nr, IC0_MASKCLR); | 463 | au_writel(1 << bit, IC0_MASKCLR); |
451 | au_writel(1 << irq_nr, IC0_WAKECLR); | 464 | au_writel(1 << bit, IC0_WAKECLR); |
452 | } | 465 | } |
453 | au_sync(); | 466 | au_sync(); |
454 | } | 467 | } |
@@ -461,8 +474,8 @@ static void setup_local_irq(unsigned int irq_nr, int type, int int_req) | |||
461 | 474 | ||
462 | static void intc0_req0_irqdispatch(void) | 475 | static void intc0_req0_irqdispatch(void) |
463 | { | 476 | { |
464 | int irq = 0; | ||
465 | static unsigned long intc0_req0; | 477 | static unsigned long intc0_req0; |
478 | unsigned int bit; | ||
466 | 479 | ||
467 | intc0_req0 |= au_readl(IC0_REQ0INT); | 480 | intc0_req0 |= au_readl(IC0_REQ0INT); |
468 | 481 | ||
@@ -481,25 +494,25 @@ static void intc0_req0_irqdispatch(void) | |||
481 | return; | 494 | return; |
482 | } | 495 | } |
483 | #endif | 496 | #endif |
484 | irq = ffs(intc0_req0); | 497 | bit = ffs(intc0_req0); |
485 | intc0_req0 &= ~(1 << irq); | 498 | intc0_req0 &= ~(1 << bit); |
486 | do_IRQ(irq); | 499 | do_IRQ(MIPS_CPU_IRQ_BASE + bit); |
487 | } | 500 | } |
488 | 501 | ||
489 | 502 | ||
490 | static void intc0_req1_irqdispatch(void) | 503 | static void intc0_req1_irqdispatch(void) |
491 | { | 504 | { |
492 | int irq = 0; | ||
493 | static unsigned long intc0_req1; | 505 | static unsigned long intc0_req1; |
506 | unsigned int bit; | ||
494 | 507 | ||
495 | intc0_req1 |= au_readl(IC0_REQ1INT); | 508 | intc0_req1 |= au_readl(IC0_REQ1INT); |
496 | 509 | ||
497 | if (!intc0_req1) | 510 | if (!intc0_req1) |
498 | return; | 511 | return; |
499 | 512 | ||
500 | irq = ffs(intc0_req1); | 513 | bit = ffs(intc0_req1); |
501 | intc0_req1 &= ~(1 << irq); | 514 | intc0_req1 &= ~(1 << bit); |
502 | do_IRQ(irq); | 515 | do_IRQ(bit); |
503 | } | 516 | } |
504 | 517 | ||
505 | 518 | ||
@@ -509,43 +522,41 @@ static void intc0_req1_irqdispatch(void) | |||
509 | */ | 522 | */ |
510 | static void intc1_req0_irqdispatch(void) | 523 | static void intc1_req0_irqdispatch(void) |
511 | { | 524 | { |
512 | int irq = 0; | ||
513 | static unsigned long intc1_req0; | 525 | static unsigned long intc1_req0; |
526 | unsigned int bit; | ||
514 | 527 | ||
515 | intc1_req0 |= au_readl(IC1_REQ0INT); | 528 | intc1_req0 |= au_readl(IC1_REQ0INT); |
516 | 529 | ||
517 | if (!intc1_req0) | 530 | if (!intc1_req0) |
518 | return; | 531 | return; |
519 | 532 | ||
520 | irq = ffs(intc1_req0); | 533 | bit = ffs(intc1_req0); |
521 | intc1_req0 &= ~(1 << irq); | 534 | intc1_req0 &= ~(1 << bit); |
522 | irq += 32; | 535 | do_IRQ(MIPS_CPU_IRQ_BASE + 32 + bit); |
523 | do_IRQ(irq); | ||
524 | } | 536 | } |
525 | 537 | ||
526 | 538 | ||
527 | static void intc1_req1_irqdispatch(void) | 539 | static void intc1_req1_irqdispatch(void) |
528 | { | 540 | { |
529 | int irq = 0; | ||
530 | static unsigned long intc1_req1; | 541 | static unsigned long intc1_req1; |
542 | unsigned int bit; | ||
531 | 543 | ||
532 | intc1_req1 |= au_readl(IC1_REQ1INT); | 544 | intc1_req1 |= au_readl(IC1_REQ1INT); |
533 | 545 | ||
534 | if (!intc1_req1) | 546 | if (!intc1_req1) |
535 | return; | 547 | return; |
536 | 548 | ||
537 | irq = ffs(intc1_req1); | 549 | bit = ffs(intc1_req1); |
538 | intc1_req1 &= ~(1 << irq); | 550 | intc1_req1 &= ~(1 << bit); |
539 | irq += 32; | 551 | do_IRQ(MIPS_CPU_IRQ_BASE + 32 + bit); |
540 | do_IRQ(irq); | ||
541 | } | 552 | } |
542 | 553 | ||
543 | asmlinkage void plat_irq_dispatch(void) | 554 | asmlinkage void plat_irq_dispatch(void) |
544 | { | 555 | { |
545 | unsigned int pending = read_c0_status() & read_c0_cause() & ST0_IM; | 556 | unsigned int pending = read_c0_status() & read_c0_cause(); |
546 | 557 | ||
547 | if (pending & CAUSEF_IP7) | 558 | if (pending & CAUSEF_IP7) |
548 | do_IRQ(63); | 559 | do_IRQ(MIPS_CPU_IRQ_BASE + 7); |
549 | else if (pending & CAUSEF_IP2) | 560 | else if (pending & CAUSEF_IP2) |
550 | intc0_req0_irqdispatch(); | 561 | intc0_req0_irqdispatch(); |
551 | else if (pending & CAUSEF_IP3) | 562 | else if (pending & CAUSEF_IP3) |
@@ -561,17 +572,15 @@ asmlinkage void plat_irq_dispatch(void) | |||
561 | void __init arch_init_irq(void) | 572 | void __init arch_init_irq(void) |
562 | { | 573 | { |
563 | int i; | 574 | int i; |
564 | unsigned long cp0_status; | ||
565 | struct au1xxx_irqmap *imp; | 575 | struct au1xxx_irqmap *imp; |
566 | extern struct au1xxx_irqmap au1xxx_irq_map[]; | 576 | extern struct au1xxx_irqmap au1xxx_irq_map[]; |
567 | extern struct au1xxx_irqmap au1xxx_ic0_map[]; | 577 | extern struct au1xxx_irqmap au1xxx_ic0_map[]; |
568 | extern int au1xxx_nr_irqs; | 578 | extern int au1xxx_nr_irqs; |
569 | extern int au1xxx_ic0_nr_irqs; | 579 | extern int au1xxx_ic0_nr_irqs; |
570 | 580 | ||
571 | cp0_status = read_c0_status(); | 581 | /* |
572 | 582 | * Initialize interrupt controllers to a safe state. | |
573 | /* Initialize interrupt controllers to a safe state. | 583 | */ |
574 | */ | ||
575 | au_writel(0xffffffff, IC0_CFG0CLR); | 584 | au_writel(0xffffffff, IC0_CFG0CLR); |
576 | au_writel(0xffffffff, IC0_CFG1CLR); | 585 | au_writel(0xffffffff, IC0_CFG1CLR); |
577 | au_writel(0xffffffff, IC0_CFG2CLR); | 586 | au_writel(0xffffffff, IC0_CFG2CLR); |
@@ -594,16 +603,20 @@ void __init arch_init_irq(void) | |||
594 | au_writel(0xffffffff, IC1_RISINGCLR); | 603 | au_writel(0xffffffff, IC1_RISINGCLR); |
595 | au_writel(0x00000000, IC1_TESTBIT); | 604 | au_writel(0x00000000, IC1_TESTBIT); |
596 | 605 | ||
597 | /* Initialize IC0, which is fixed per processor. | 606 | mips_cpu_irq_init(); |
598 | */ | 607 | |
608 | /* | ||
609 | * Initialize IC0, which is fixed per processor. | ||
610 | */ | ||
599 | imp = au1xxx_ic0_map; | 611 | imp = au1xxx_ic0_map; |
600 | for (i = 0; i < au1xxx_ic0_nr_irqs; i++) { | 612 | for (i = 0; i < au1xxx_ic0_nr_irqs; i++) { |
601 | setup_local_irq(imp->im_irq, imp->im_type, imp->im_request); | 613 | setup_local_irq(imp->im_irq, imp->im_type, imp->im_request); |
602 | imp++; | 614 | imp++; |
603 | } | 615 | } |
604 | 616 | ||
605 | /* Now set up the irq mapping for the board. | 617 | /* |
606 | */ | 618 | * Now set up the irq mapping for the board. |
619 | */ | ||
607 | imp = au1xxx_irq_map; | 620 | imp = au1xxx_irq_map; |
608 | for (i = 0; i < au1xxx_nr_irqs; i++) { | 621 | for (i = 0; i < au1xxx_nr_irqs; i++) { |
609 | setup_local_irq(imp->im_irq, imp->im_type, imp->im_request); | 622 | setup_local_irq(imp->im_irq, imp->im_type, imp->im_request); |
@@ -615,5 +628,5 @@ void __init arch_init_irq(void) | |||
615 | /* Board specific IRQ initialization. | 628 | /* Board specific IRQ initialization. |
616 | */ | 629 | */ |
617 | if (board_init_irq) | 630 | if (board_init_irq) |
618 | (*board_init_irq)(); | 631 | board_init_irq(); |
619 | } | 632 | } |