53 lines
1.3 KiB
ArmAsm
53 lines
1.3 KiB
ArmAsm
|
/*
|
||
|
|
* arch/arm/mach-clps711x/include/mach/entry-macro.S
|
||
|
|
*
|
||
|
|
* Low-level IRQ helper macros for CLPS711X-based platforms
|
||
|
|
*
|
||
|
|
* This file is licensed under the terms of the GNU General Public
|
||
|
|
* License version 2. This program is licensed "as is" without any
|
||
|
|
* warranty of any kind, whether express or implied.
|
||
|
|
*/
|
||
|
|
#include <mach/hardware.h>
|
||
|
|
#include <asm/hardware/clps7111.h>
|
||
|
|
|
||
|
|
.macro get_irqnr_preamble, base, tmp
|
||
|
|
.endm
|
||
|
|
|
||
|
|
#if (INTSR2 - INTSR1) != (INTMR2 - INTMR1)
|
||
|
|
#error INTSR stride != INTMR stride
|
||
|
|
#endif
|
||
|
|
|
||
|
|
.macro get_irqnr_and_base, irqnr, stat, base, mask
|
||
|
|
mov \base, #CLPS7111_BASE
|
||
|
|
ldr \stat, [\base, #INTSR1]
|
||
|
|
ldr \mask, [\base, #INTMR1]
|
||
|
|
mov \irqnr, #4
|
||
|
|
mov \mask, \mask, lsl #16
|
||
|
|
and \stat, \stat, \mask, lsr #16
|
||
|
|
movs \stat, \stat, lsr #4
|
||
|
|
bne 1001f
|
||
|
|
|
||
|
|
add \base, \base, #INTSR2 - INTSR1
|
||
|
|
ldr \stat, [\base, #INTSR1]
|
||
|
|
ldr \mask, [\base, #INTMR1]
|
||
|
|
mov \irqnr, #16
|
||
|
|
mov \mask, \mask, lsl #16
|
||
|
|
and \stat, \stat, \mask, lsr #16
|
||
|
|
|
||
|
|
1001: tst \stat, #255
|
||
|
|
addeq \irqnr, \irqnr, #8
|
||
|
|
moveq \stat, \stat, lsr #8
|
||
|
|
tst \stat, #15
|
||
|
|
addeq \irqnr, \irqnr, #4
|
||
|
|
moveq \stat, \stat, lsr #4
|
||
|
|
tst \stat, #3
|
||
|
|
addeq \irqnr, \irqnr, #2
|
||
|
|
moveq \stat, \stat, lsr #2
|
||
|
|
tst \stat, #1
|
||
|
|
addeq \irqnr, \irqnr, #1
|
||
|
|
moveq \stat, \stat, lsr #1
|
||
|
|
tst \stat, #1 @ bit 0 should be set
|
||
|
|
.endm
|
||
|
|
|
||
|
|
|