58f0d71759f6606f342652b8f61702cf7e3a2168
[linux-2.6.git] / include / asm-arm / arch-versatile / entry-macro.S
1 /*
2  * include/asm-arm/arch-versatile/entry-macro.S
3  *
4  * Low-level IRQ helper macros for Versatile platforms
5  *
6  * This file is licensed under  the terms of the GNU General Public
7  * License version 2. This program is licensed "as is" without any
8  * warranty of any kind, whether express or implied.
9  */
10 #include <asm/hardware.h>
11
12                 .macro  disable_fiq
13                 .endm
14
15                 .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
16                 ldr     \base, =IO_ADDRESS(VERSATILE_VIC_BASE)
17                 ldr     \irqstat, [\base, #VIC_IRQ_STATUS]      @ get masked status
18                 mov     \irqnr, #0
19                 teq     \irqstat, #0
20                 beq     1003f
21
22 1001:           tst     \irqstat, #15
23                 bne     1002f
24                 add     \irqnr, \irqnr, #4
25                 movs    \irqstat, \irqstat, lsr #4
26                 bne     1001b
27 1002:           tst     \irqstat, #1
28                 bne     1003f
29                 add     \irqnr, \irqnr, #1
30                 movs    \irqstat, \irqstat, lsr #1
31                 bne     1002b
32 1003:           /* EQ will be set if no irqs pending */
33
34 @               clz     \irqnr, \irqstat
35 @1003:          /* EQ will be set if we reach MAXIRQNUM */
36                 .endm
37