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
43#include <machine/asm.h>
44#include <machine/setjmp.h>
45
| 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
43#include <machine/asm.h>
44#include <machine/setjmp.h>
45
|
46__FBSDID("$FreeBSD: stable/10/lib/libc/arm/gen/setjmp.S 251514 2013-06-07 22:01:06Z andrew $");
| 46__FBSDID("$FreeBSD: stable/10/lib/libc/arm/gen/setjmp.S 271337 2014-09-09 22:24:01Z ian $");
|
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
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__ */
| 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
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__ */
|
| 104END(setjmp)
|
104
| 105
|
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
111 bic r3, r2, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP)
112 teq r3, ip
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
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 */
| 106.weak _C_LABEL(longjmp)
107.set _C_LABEL(longjmp), _C_LABEL(__longjmp)
108ENTRY(__longjmp)
109 ldr r2, [r0]
110 ldr ip, .Lsetjmp_magic
111 bic r3, r2, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP)
112 teq r3, ip
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
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 */
|
| 153END(__longjmp)
|
| |