| Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame^] | 1 | /* |
| 2 | * arch/arm/mach-ep93xx/include/mach/entry-macro.S |
| 3 | * IRQ demultiplexing for EP93xx |
| 4 | * |
| 5 | * Copyright (C) 2006 Lennert Buytenhek <buytenh@wantstofly.org> |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License as published by |
| 9 | * the Free Software Foundation; either version 2 of the License, or (at |
| 10 | * your option) any later version. |
| 11 | */ |
| 12 | #include <mach/ep93xx-regs.h> |
| 13 | |
| 14 | .macro disable_fiq |
| 15 | .endm |
| 16 | |
| 17 | .macro get_irqnr_preamble, base, tmp |
| 18 | .endm |
| 19 | |
| 20 | .macro arch_ret_to_user, tmp1, tmp2 |
| 21 | .endm |
| 22 | |
| 23 | .macro get_irqnr_and_base, irqnr, irqstat, base, tmp |
| 24 | ldr \base, =(EP93XX_AHB_VIRT_BASE) |
| 25 | orr \base, \base, #0x000b0000 |
| 26 | mov \irqnr, #0 |
| 27 | ldr \irqstat, [\base] @ lower 32 interrupts |
| 28 | cmp \irqstat, #0 |
| 29 | bne 1001f |
| 30 | |
| 31 | eor \base, \base, #0x00070000 |
| 32 | ldr \irqstat, [\base] @ upper 32 interrupts |
| 33 | cmp \irqstat, #0 |
| 34 | beq 1002f |
| 35 | mov \irqnr, #0x20 |
| 36 | |
| 37 | 1001: |
| 38 | movs \tmp, \irqstat, lsl #16 |
| 39 | movne \irqstat, \tmp |
| 40 | addeq \irqnr, \irqnr, #16 |
| 41 | |
| 42 | movs \tmp, \irqstat, lsl #8 |
| 43 | movne \irqstat, \tmp |
| 44 | addeq \irqnr, \irqnr, #8 |
| 45 | |
| 46 | movs \tmp, \irqstat, lsl #4 |
| 47 | movne \irqstat, \tmp |
| 48 | addeq \irqnr, \irqnr, #4 |
| 49 | |
| 50 | movs \tmp, \irqstat, lsl #2 |
| 51 | movne \irqstat, \tmp |
| 52 | addeq \irqnr, \irqnr, #2 |
| 53 | |
| 54 | movs \tmp, \irqstat, lsl #1 |
| 55 | addeq \irqnr, \irqnr, #1 |
| 56 | orrs \base, \base, #1 |
| 57 | |
| 58 | 1002: |
| 59 | .endm |