Merge branch 'smsc911x-armplatforms' of git://github.com/steveglen/linux-2.6
[linux-2.6.git] / arch / arm / vfp / entry.S
1 /*
2  *  linux/arch/arm/vfp/entry.S
3  *
4  *  Copyright (C) 2004 ARM Limited.
5  *  Written by Deep Blue Solutions Limited.
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 version 2 as
9  * published by the Free Software Foundation.
10  *
11  * Basic entry code, called from the kernel's undefined instruction trap.
12  *  r0  = faulted instruction
13  *  r5  = faulted PC+4
14  *  r9  = successful return
15  *  r10 = thread_info structure
16  *  lr  = failure return
17  */
18 #include <asm/thread_info.h>
19 #include <asm/vfpmacros.h>
20 #include "../kernel/entry-header.S"
21
22 ENTRY(do_vfp)
23 #ifdef CONFIG_PREEMPT
24         ldr     r4, [r10, #TI_PREEMPT]  @ get preempt count
25         add     r11, r4, #1             @ increment it
26         str     r11, [r10, #TI_PREEMPT]
27 #endif
28         enable_irq
29         ldr     r4, .LCvfp
30         ldr     r11, [r10, #TI_CPU]     @ CPU number
31         add     r10, r10, #TI_VFPSTATE  @ r10 = workspace
32         ldr     pc, [r4]                @ call VFP entry point
33 ENDPROC(do_vfp)
34
35 ENTRY(vfp_null_entry)
36 #ifdef CONFIG_PREEMPT
37         get_thread_info r10
38         ldr     r4, [r10, #TI_PREEMPT]  @ get preempt count
39         sub     r11, r4, #1             @ decrement it
40         str     r11, [r10, #TI_PREEMPT]
41 #endif
42         mov     pc, lr
43 ENDPROC(vfp_null_entry)
44
45 .LCvfp:
46         .word   vfp_vector
47
48 @ This code is called if the VFP does not exist. It needs to flag the
49 @ failure to the VFP initialisation code.
50
51         __INIT
52 ENTRY(vfp_testing_entry)
53 #ifdef CONFIG_PREEMPT
54         get_thread_info r10
55         ldr     r4, [r10, #TI_PREEMPT]  @ get preempt count
56         sub     r11, r4, #1             @ decrement it
57         str     r11, [r10, #TI_PREEMPT]
58 #endif
59         ldr     r0, VFP_arch_address
60         str     r5, [r0]                @ known non-zero value
61         mov     pc, r9                  @ we have handled the fault
62 ENDPROC(vfp_testing_entry)
63
64 VFP_arch_address:
65         .word   VFP_arch
66
67         __FINIT