blob: feff771c0a0a950630cbef18d231da9c5d665d47 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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 */
Russell King78ff18a2006-01-03 17:39:34 +000010#include <asm/hardware.h>
Russell Kingfa0fe482006-01-13 21:30:48 +000011#include <asm/hardware/vic.h>
Russell King78ff18a2006-01-03 17:39:34 +000012
13 .macro disable_fiq
Linus Torvalds1da177e2005-04-16 15:20:36 -070014 .endm
15
16 .macro get_irqnr_and_base, irqnr, irqstat, base, tmp
17 ldr \base, =IO_ADDRESS(VERSATILE_VIC_BASE)
18 ldr \irqstat, [\base, #VIC_IRQ_STATUS] @ get masked status
19 mov \irqnr, #0
20 teq \irqstat, #0
21 beq 1003f
22
231001: tst \irqstat, #15
24 bne 1002f
25 add \irqnr, \irqnr, #4
26 movs \irqstat, \irqstat, lsr #4
27 bne 1001b
281002: tst \irqstat, #1
29 bne 1003f
30 add \irqnr, \irqnr, #1
31 movs \irqstat, \irqstat, lsr #1
32 bne 1002b
331003: /* EQ will be set if no irqs pending */
34
35@ clz \irqnr, \irqstat
36@1003: /* EQ will be set if we reach MAXIRQNUM */
37 .endm
38