1/* $NetBSD: setjmp.S,v 1.14 2013/04/19 13:45:45 matt Exp $ */
2
3/*
4 * Copyright (c) 1997 Mark Brinicombe
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed by Mark Brinicombe
18 * 4. Neither the name of the University nor the names of its contributors
19 * may be used to endorse or promote products derived from this software
20 * without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 * SUCH DAMAGE.
33 */
34
35#if !defined(__SOFTFP__) && !defined(__VFP_FP__) && !defined(__ARM_PCS)
36#error FPA is not supported anymore
37#endif
38
| 1/* $NetBSD: setjmp.S,v 1.14 2013/04/19 13:45:45 matt Exp $ */
2
3/*
4 * Copyright (c) 1997 Mark Brinicombe
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 * 3. All advertising materials mentioning features or use of this software
16 * must display the following acknowledgement:
17 * This product includes software developed by Mark Brinicombe
18 * 4. Neither the name of the University nor the names of its contributors
19 * may be used to endorse or promote products derived from this software
20 * without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
23 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
26 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32 * SUCH DAMAGE.
33 */
34
35#if !defined(__SOFTFP__) && !defined(__VFP_FP__) && !defined(__ARM_PCS)
36#error FPA is not supported anymore
37#endif
38
|
| 39#ifdef __ARM_EABI__
40 .fpu vfp
41#endif
42
|
39#include <machine/asm.h>
40#include <machine/setjmp.h>
41
| 43#include <machine/asm.h>
44#include <machine/setjmp.h>
45
|
42__FBSDID("$FreeBSD: head/lib/libc/arm/gen/setjmp.S 251405 2013-06-05 07:37:45Z andrew $");
| 46__FBSDID("$FreeBSD: head/lib/libc/arm/gen/setjmp.S 251514 2013-06-07 22:01:06Z andrew $");
|
43
44/*
45 * C library -- setjmp, longjmp
46 *
47 * longjmp(a,v)
48 * will generate a "return(v)" from the last call to
49 * setjmp(a)
50 * by restoring registers from the stack.
51 * The previous signal state is restored.
52 */
53
54ENTRY(setjmp)
55 /* Block all signals and retrieve the old signal mask */
56 stmfd sp!, {r0, r14}
57 add r2, r0, #(_JB_SIGMASK * 4) /* oset */
58 mov r1, #0x00000000 /* set */
59 mov r0, #0x00000001 /* SIG_BLOCK */
60 bl PIC_SYM(_C_LABEL(sigprocmask), PLT)
61 ldmfd sp!, {r0, r14}
62
63 ldr r1, .Lsetjmp_magic
| 47
48/*
49 * C library -- setjmp, longjmp
50 *
51 * longjmp(a,v)
52 * will generate a "return(v)" from the last call to
53 * setjmp(a)
54 * by restoring registers from the stack.
55 * The previous signal state is restored.
56 */
57
58ENTRY(setjmp)
59 /* Block all signals and retrieve the old signal mask */
60 stmfd sp!, {r0, r14}
61 add r2, r0, #(_JB_SIGMASK * 4) /* oset */
62 mov r1, #0x00000000 /* set */
63 mov r0, #0x00000001 /* SIG_BLOCK */
64 bl PIC_SYM(_C_LABEL(sigprocmask), PLT)
65 ldmfd sp!, {r0, r14}
66
67 ldr r1, .Lsetjmp_magic
|
| 68
69#ifdef __ARM_EABI__
70 ldr r2, .Lfpu_present
71#ifdef PIC
72 GOT_INIT(r3, .Lsetjmp_got, .Lsetjmp_gotinit)
73 ldr r2, [r2, r3]
74#else
75 ldr r2, [r2]
76#endif
77 teq r2, #0 /* do we have a FPU? */
78 beq 1f /* no, don't save VFP registers */
79
80 orr r1, r1, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP)
81 /* change magic to VFP magic */
82 add r2, r0, #(_JB_REG_D8 * 4)
83 vstmia r2, {d8-d15}
84 vmrs r2, fpscr
85 str r2, [r0, #(_JB_REG_FPSCR * 4)]
861:
87#endif /* __ARM_EABI__ */
88
|
64 str r1, [r0] /* store magic */
65
66 /* Store integer registers */
67 add r0, r0, #(_JB_REG_R4 * 4)
68 stmia r0, {r4-r14}
69 mov r0, #0x00000000
70 RET
71
72.Lsetjmp_magic:
73 .word _JB_MAGIC_SETJMP
| 89 str r1, [r0] /* store magic */
90
91 /* Store integer registers */
92 add r0, r0, #(_JB_REG_R4 * 4)
93 stmia r0, {r4-r14}
94 mov r0, #0x00000000
95 RET
96
97.Lsetjmp_magic:
98 .word _JB_MAGIC_SETJMP
|
| 99#ifdef __ARM_EABI__
100 GOT_INITSYM(.Lsetjmp_got, .Lsetjmp_gotinit)
101.Lfpu_present:
102 .word PIC_SYM(_libc_arm_fpu_present, GOTOFF)
103#endif /* __ARM_EABI__ */
|
74
75
76.weak _C_LABEL(longjmp)
77.set _C_LABEL(longjmp), _C_LABEL(__longjmp)
78ENTRY(__longjmp)
79 ldr r2, [r0]
80 ldr ip, .Lsetjmp_magic
| 104
105
106.weak _C_LABEL(longjmp)
107.set _C_LABEL(longjmp), _C_LABEL(__longjmp)
108ENTRY(__longjmp)
109 ldr r2, [r0]
110 ldr ip, .Lsetjmp_magic
|
81 teq r2, ip
| 111 bic r3, r2, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP)
112 teq r3, ip
|
82 bne .Lbotch
83
84 /* Restore the signal mask. */
85 stmfd sp!, {r0-r2, r14}
86 mov r2, #0x00000000
87 add r1, r0, #(_JB_SIGMASK * 4) /* Signal mask */
88 mov r0, #3 /* SIG_SETMASK */
89 bl PIC_SYM(_C_LABEL(sigprocmask), PLT)
90 ldmfd sp!, {r0-r2, r14}
91
| 113 bne .Lbotch
114
115 /* Restore the signal mask. */
116 stmfd sp!, {r0-r2, r14}
117 mov r2, #0x00000000
118 add r1, r0, #(_JB_SIGMASK * 4) /* Signal mask */
119 mov r0, #3 /* SIG_SETMASK */
120 bl PIC_SYM(_C_LABEL(sigprocmask), PLT)
121 ldmfd sp!, {r0-r2, r14}
122
|
| 123#ifdef __ARM_EABI__
124 tst r2, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP)
125 /* is this a VFP magic? */
126 beq 1f /* no, don't restore VFP */
127 add ip, r0, #(_JB_REG_D8 * 4)
128 vldmia ip, {d8-d15}
129 ldr ip, [r0, #(_JB_REG_FPSCR * 4)]
130 vmsr fpscr, ip
1311:
132#endif /* __ARM_EABI__ */
133
|
92 add r0, r0, #(_JB_REG_R4 * 4)
93 /* Restore integer registers */
94 ldmia r0, {r4-r14}
95
96 /* Validate sp and r14 */
97 teq sp, #0
98 teqne r14, #0
99 beq .Lbotch
100
101 /* Set return value */
102 movs r0, r1
103 moveq r0, #0x00000001
104 RET
105
106 /* validation failed, die die die. */
107.Lbotch:
108 bl PIC_SYM(_C_LABEL(longjmperror), PLT)
109 bl PIC_SYM(_C_LABEL(abort), PLT)
110 b . - 8 /* Cannot get here */
| 134 add r0, r0, #(_JB_REG_R4 * 4)
135 /* Restore integer registers */
136 ldmia r0, {r4-r14}
137
138 /* Validate sp and r14 */
139 teq sp, #0
140 teqne r14, #0
141 beq .Lbotch
142
143 /* Set return value */
144 movs r0, r1
145 moveq r0, #0x00000001
146 RET
147
148 /* validation failed, die die die. */
149.Lbotch:
150 bl PIC_SYM(_C_LABEL(longjmperror), PLT)
151 bl PIC_SYM(_C_LABEL(abort), PLT)
152 b . - 8 /* Cannot get here */
|