37 lines
1009 B
ArmAsm
37 lines
1009 B
ArmAsm
/*
|
|
* arch/arm/mach-shark/include/mach/entry-macro.S
|
|
*
|
|
* Low-level IRQ helper macros for Shark platform
|
|
*
|
|
* 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.
|
|
*/
|
|
.macro get_irqnr_preamble, base, tmp
|
|
mov \base, #0xfe000000
|
|
orr \base, \base, #0x00e00000
|
|
.endm
|
|
|
|
.macro get_irqnr_and_base, irqnr, irqstat, base, tmp
|
|
|
|
mov \irqstat, #0x0C
|
|
strb \irqstat, [\base, #0x20] @outb(0x0C, 0x20) /* Poll command */
|
|
ldrb \irqnr, [\base, #0x20] @irq = inb(0x20) & 7
|
|
and \irqstat, \irqnr, #0x80
|
|
teq \irqstat, #0
|
|
beq 43f
|
|
and \irqnr, \irqnr, #7
|
|
teq \irqnr, #2
|
|
bne 44f
|
|
43: mov \irqstat, #0x0C
|
|
strb \irqstat, [\base, #0xa0] @outb(0x0C, 0xA0) /* Poll command */
|
|
ldrb \irqnr, [\base, #0xa0] @irq = (inb(0xA0) & 7) + 8
|
|
and \irqstat, \irqnr, #0x80
|
|
teq \irqstat, #0
|
|
beq 44f
|
|
and \irqnr, \irqnr, #7
|
|
add \irqnr, \irqnr, #8
|
|
44: teq \irqstat, #0
|
|
.endm
|
|
|