Ben Dooks | 5b39be4 | 2010-01-07 08:59:26 +0900 | [diff] [blame^] | 1 | /* arch/arm/include/asm/entry-macro-vic2.S |
| 2 | * |
| 3 | * Originally arch/arm/mach-s3c6400/include/mach/entry-macro.S |
| 4 | * |
| 5 | * Copyright 2008 Openmoko, Inc. |
| 6 | * Copyright 2008 Simtec Electronics |
| 7 | * http://armlinux.simtec.co.uk/ |
| 8 | * Ben Dooks <ben@simtec.co.uk> |
| 9 | * |
| 10 | * Low-level IRQ helper macros for a device with two VICs |
| 11 | * |
| 12 | * This file is licensed under the terms of the GNU General Public |
| 13 | * License version 2. This program is licensed "as is" without any |
| 14 | * warranty of any kind, whether express or implied. |
| 15 | */ |
| 16 | |
| 17 | /* This should be included from <mach/entry-macro.S> with the necessary |
| 18 | * defines for virtual addresses and IRQ bases for the two vics. |
| 19 | * |
| 20 | * The code needs the following defined: |
| 21 | * IRQ_VIC0_BASE IRQ number of VIC0's first IRQ |
| 22 | * IRQ_VIC1_BASE IRQ number of VIC1's first IRQ |
| 23 | * VA_VIC0 Virtual address of VIC0 |
| 24 | * VA_VIC1 Virtual address of VIC1 |
| 25 | * |
| 26 | * Note, code assumes VIC0's virtual address is an ARM immediate constant |
| 27 | * away from VIC1. |
| 28 | */ |
| 29 | |
| 30 | #include <asm/hardware/vic.h> |
| 31 | |
| 32 | .macro disable_fiq |
| 33 | .endm |
| 34 | |
| 35 | .macro get_irqnr_preamble, base, tmp |
| 36 | ldr \base, =VA_VIC0 |
| 37 | .endm |
| 38 | |
| 39 | .macro arch_ret_to_user, tmp1, tmp2 |
| 40 | .endm |
| 41 | |
| 42 | .macro get_irqnr_and_base, irqnr, irqstat, base, tmp |
| 43 | |
| 44 | @ check the vic0 |
| 45 | mov \irqnr, #IRQ_VIC0_BASE + 31 |
| 46 | ldr \irqstat, [ \base, # VIC_IRQ_STATUS ] |
| 47 | teq \irqstat, #0 |
| 48 | |
| 49 | @ otherwise try vic1 |
| 50 | addeq \tmp, \base, #(VA_VIC1 - VA_VIC0) |
| 51 | addeq \irqnr, \irqnr, #(IRQ_VIC1_BASE - IRQ_VIC0_BASE) |
| 52 | ldreq \irqstat, [ \tmp, # VIC_IRQ_STATUS ] |
| 53 | teqeq \irqstat, #0 |
| 54 | |
| 55 | clzne \irqstat, \irqstat |
| 56 | subne \irqnr, \irqnr, \irqstat |
| 57 | .endm |