2 * Carsten Langgaard, carstenl@mips.com
3 * Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved.
5 * ########################################################################
7 * This program is free software; you can distribute it and/or modify it
8 * under the terms of the GNU General Public License (Version 2) as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
20 * ########################################################################
22 * Routines for generic manipulation of the interrupts found on the MIPS
26 #include <linux/compiler.h>
27 #include <linux/init.h>
28 #include <linux/sched.h>
29 #include <linux/slab.h>
30 #include <linux/interrupt.h>
31 #include <linux/kernel_stat.h>
35 #include <asm/mips-boards/atlas.h>
36 #include <asm/mips-boards/atlasint.h>
37 #include <asm/gdb-stub.h>
40 static struct atlas_ictrl_regs
*atlas_hw0_icregs
;
43 #define DEBUG_INT(x...) printk(x)
45 #define DEBUG_INT(x...)
48 void disable_atlas_irq(unsigned int irq_nr
)
50 atlas_hw0_icregs
->intrsten
= (1 << (irq_nr
-ATLASINT_BASE
));
54 void enable_atlas_irq(unsigned int irq_nr
)
56 atlas_hw0_icregs
->intseten
= (1 << (irq_nr
-ATLASINT_BASE
));
60 static unsigned int startup_atlas_irq(unsigned int irq
)
62 enable_atlas_irq(irq
);
63 return 0; /* never anything pending */
66 #define shutdown_atlas_irq disable_atlas_irq
68 #define mask_and_ack_atlas_irq disable_atlas_irq
70 static void end_atlas_irq(unsigned int irq
)
72 if (!(irq_desc
[irq
].status
& (IRQ_DISABLED
|IRQ_INPROGRESS
)))
73 enable_atlas_irq(irq
);
76 static struct hw_interrupt_type atlas_irq_type
= {
78 .startup
= startup_atlas_irq
,
79 .shutdown
= shutdown_atlas_irq
,
80 .enable
= enable_atlas_irq
,
81 .disable
= disable_atlas_irq
,
82 .ack
= mask_and_ack_atlas_irq
,
86 static inline int ls1bit32(unsigned int x
)
90 s
= 16; if (x
<< 16 == 0) s
= 0; b
-= s
; x
<<= s
;
91 s
= 8; if (x
<< 8 == 0) s
= 0; b
-= s
; x
<<= s
;
92 s
= 4; if (x
<< 4 == 0) s
= 0; b
-= s
; x
<<= s
;
93 s
= 2; if (x
<< 2 == 0) s
= 0; b
-= s
; x
<<= s
;
94 s
= 1; if (x
<< 1 == 0) s
= 0; b
-= s
;
99 static inline void atlas_hw0_irqdispatch(struct pt_regs
*regs
)
101 unsigned long int_status
;
104 int_status
= atlas_hw0_icregs
->intstatus
;
106 /* if int_status == 0, then the interrupt has already been cleared */
107 if (unlikely(int_status
== 0))
110 irq
= ATLASINT_BASE
+ ls1bit32(int_status
);
112 DEBUG_INT("atlas_hw0_irqdispatch: irq=%d\n", irq
);
117 static inline int clz(unsigned long x
)
131 * Version of ffs that only looks at bits 12..15.
133 static inline unsigned int irq_ffs(unsigned int pending
)
135 #if defined(CONFIG_CPU_MIPS32) || defined(CONFIG_CPU_MIPS64)
136 return -clz(pending
) + 31 - CAUSEB_IP
;
164 * IRQs on the Atlas board look basically (barring software IRQs which we
165 * don't use at all and all external interrupt sources are combined together
166 * on hardware interrupt 0 (MIPS IRQ 2)) like:
170 * 0 Software (ignored)
171 * 1 Software (ignored)
172 * 2 Combined hardware interrupt (hw0)
173 * 3 Hardware (ignored)
174 * 4 Hardware (ignored)
175 * 5 Hardware (ignored)
176 * 6 Hardware (ignored)
177 * 7 R4k timer (what we use)
179 * We handle the IRQ according to _our_ priority which is:
181 * Highest ---- R4k Timer
182 * Lowest ---- Combined hardware interrupt
184 * then we just return, if multiple IRQs are pending then we will just take
185 * another exception, big deal.
187 asmlinkage
void plat_irq_dispatch(struct pt_regs
*regs
)
189 unsigned int pending
= read_c0_cause() & read_c0_status() & ST0_IM
;
192 irq
= irq_ffs(pending
);
194 if (irq
== MIPSCPU_INT_ATLAS
)
195 atlas_hw0_irqdispatch(regs
);
197 do_IRQ(MIPSCPU_INT_BASE
+ irq
, regs
);
199 spurious_interrupt(regs
);
202 void __init
arch_init_irq(void)
206 atlas_hw0_icregs
= (struct atlas_ictrl_regs
*)ioremap (ATLAS_ICTRL_REGS_BASE
, sizeof(struct atlas_ictrl_regs
*));
209 * Mask out all interrupt by writing "1" to all bit position in
210 * the interrupt reset reg.
212 atlas_hw0_icregs
->intrsten
= 0xffffffff;
214 for (i
= ATLASINT_BASE
; i
<= ATLASINT_END
; i
++) {
215 irq_desc
[i
].status
= IRQ_DISABLED
;
216 irq_desc
[i
].action
= 0;
217 irq_desc
[i
].depth
= 1;
218 irq_desc
[i
].handler
= &atlas_irq_type
;
219 spin_lock_init(&irq_desc
[i
].lock
);