[BLUETOOTH]: Fix bugs in previous conn add/del workqueue changes.
[linux-2.6/linux-2.6-openrd.git] / include / asm-arm / arch-integrator / entry-macro.S
blob491af1a23de55ca28cf35703009ce72e30142d68
1 /*
2  * include/asm-arm/arch-integrator/entry-macro.S
3  *
4  * Low-level IRQ helper macros for Integrator 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 #include <asm/arch/irqs.h>
13                 .macro  disable_fiq
14                 .endm
16                 .macro  get_irqnr_preamble, base, tmp
17                 .endm
19                 .macro  arch_ret_to_user, tmp1, tmp2
20                 .endm
22                 .macro  get_irqnr_and_base, irqnr, irqstat, base, tmp
23 /* FIXME: should not be using soo many LDRs here */
24                 ldr     \base, =IO_ADDRESS(INTEGRATOR_IC_BASE)
25                 mov     \irqnr, #IRQ_PIC_START
26                 ldr     \irqstat, [\base, #IRQ_STATUS]          @ get masked status
27                 ldr     \base, =IO_ADDRESS(INTEGRATOR_HDR_BASE)
28                 teq     \irqstat, #0
29                 ldreq   \irqstat, [\base, #(INTEGRATOR_HDR_IC_OFFSET+IRQ_STATUS)]
30                 moveq   \irqnr, #IRQ_CIC_START
32 1001:           tst     \irqstat, #15
33                 bne     1002f
34                 add     \irqnr, \irqnr, #4
35                 movs    \irqstat, \irqstat, lsr #4
36                 bne     1001b
37 1002:           tst     \irqstat, #1
38                 bne     1003f
39                 add     \irqnr, \irqnr, #1
40                 movs    \irqstat, \irqstat, lsr #1
41                 bne     1002b
42 1003:           /* EQ will be set if no irqs pending */
43                 .endm