1/* $NetBSD: _setjmp.S,v 1.12 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.12 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__
| 39#if defined(__ARM_EABI__) && !defined(_STANDALONE)
|
40 .fpu vfp
41#endif
42
43#include <machine/asm.h>
44#include <machine/setjmp.h>
45
| 40 .fpu vfp
41#endif
42
43#include <machine/asm.h>
44#include <machine/setjmp.h>
45
|
46__FBSDID("$FreeBSD: head/lib/libc/arm/gen/_setjmp.S 251392 2013-06-04 19:47:26Z andrew $");
| 46__FBSDID("$FreeBSD: head/lib/libc/arm/gen/_setjmp.S 251514 2013-06-07 22:01:06Z andrew $");
|
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 NOT restored.
56 *
57 * Note: r0 is the return value
58 * r1-r3,ip are scratch registers in functions
59 */
60
61ENTRY(_setjmp)
62 ldr r1, .L_setjmp_magic
63
| 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 NOT restored.
56 *
57 * Note: r0 is the return value
58 * r1-r3,ip are scratch registers in functions
59 */
60
61ENTRY(_setjmp)
62 ldr r1, .L_setjmp_magic
63
|
| 64#if defined(__ARM_EABI__) && !defined(_STANDALONE)
65 ldr r2, .Lfpu_present
66#ifdef PIC
67 GOT_INIT(r3, .L_setjmp_got, .L_setjmp_gotinit)
68 ldr r2, [r2, r3]
69#else
70 ldr r2, [r2]
71#endif
72 teq r2, #0 /* do we have a FPU? */
73 beq 1f /* no, don't save VFP registers */
74
75 orr r1, r1, #(_JB_MAGIC__SETJMP ^ _JB_MAGIC__SETJMP_VFP)
76 /* change magic to VFP magic */
77 add r2, r0, #(_JB_REG_D8 * 4)
78 vstmia r2, {d8-d15}
79 vmrs r2, fpscr
80 str r2, [r0, #(_JB_REG_FPSCR * 4)]
811:
82#endif /* __ARM_EABI__ */
83
|
64 str r1, [r0]
65
66 add r0, r0, #(_JB_REG_R4 * 4)
67 /* Store integer registers */
68 stmia r0, {r4-r14}
69
70 mov r0, #0x00000000
71 RET
72
73.L_setjmp_magic:
74 .word _JB_MAGIC__SETJMP
| 84 str r1, [r0]
85
86 add r0, r0, #(_JB_REG_R4 * 4)
87 /* Store integer registers */
88 stmia r0, {r4-r14}
89
90 mov r0, #0x00000000
91 RET
92
93.L_setjmp_magic:
94 .word _JB_MAGIC__SETJMP
|
| 95#if defined(__ARM_EABI__) && !defined(_STANDALONE)
96 GOT_INITSYM(.L_setjmp_got, .L_setjmp_gotinit)
97.Lfpu_present:
98 .word PIC_SYM(_libc_arm_fpu_present, GOTOFF)
99#endif /* __ARM_EABI__ */
|
75
76WEAK_ALIAS(___longjmp, _longjmp)
77ENTRY(_longjmp)
78 ldr r2, [r0] /* get magic from jmp_buf */
| 100
101WEAK_ALIAS(___longjmp, _longjmp)
102ENTRY(_longjmp)
103 ldr r2, [r0] /* get magic from jmp_buf */
|
| 104 bic r3, r2, #(_JB_MAGIC__SETJMP ^ _JB_MAGIC__SETJMP_VFP)
105 /* ignore VFP-ness of magic */
|
79 ldr ip, .L_setjmp_magic /* load magic */
| 106 ldr ip, .L_setjmp_magic /* load magic */
|
80 teq ip, r2 /* magic correct? */
| 107 teq ip, r3 /* magic correct? */
|
81 bne botch /* no, botch */
82
| 108 bne botch /* no, botch */
109
|
| 110#if defined(__ARM_EABI__) && !defined(_STANDALONE)
111 teq r3, r2 /* did magic change? */
112 beq 1f /* no, don't restore VFP */
113 add ip, r0, #(_JB_REG_D8 * 4)
114 vldmia ip, {d8-d15}
115 ldr ip, [r0, #(_JB_REG_FPSCR * 4)]
116 vmsr fpscr, ip
1171:
118#endif /* __ARM_EABI__ */
119
|
83 add r0, r0, #(_JB_REG_R4 * 4)
84 /* Restore integer registers */
85 ldmia r0, {r4-r14}
86
87 /* Validate sp and r14 */
88 teq sp, #0
89 teqne r14, #0
90 beq botch
91
92 /* Set return value */
93 movs r0, r1
94 moveq r0, #0x00000001
95 RET
96
97 /* validation failed, die die die. */
98botch:
99#if !defined(_STANDALONE)
100 bl PIC_SYM(_C_LABEL(longjmperror), PLT)
101 bl PIC_SYM(_C_LABEL(abort), PLT)
102 b . - 8 /* Cannot get here */
103#else
104 b .
105#endif
| 120 add r0, r0, #(_JB_REG_R4 * 4)
121 /* Restore integer registers */
122 ldmia r0, {r4-r14}
123
124 /* Validate sp and r14 */
125 teq sp, #0
126 teqne r14, #0
127 beq botch
128
129 /* Set return value */
130 movs r0, r1
131 moveq r0, #0x00000001
132 RET
133
134 /* validation failed, die die die. */
135botch:
136#if !defined(_STANDALONE)
137 bl PIC_SYM(_C_LABEL(longjmperror), PLT)
138 bl PIC_SYM(_C_LABEL(abort), PLT)
139 b . - 8 /* Cannot get here */
140#else
141 b .
142#endif
|