1 /* $NetBSD: setjmp.S,v 1.14 2013/04/19 13:45:45 matt Exp $ */
4 * Copyright (c) 1997 Mark Brinicombe
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
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.
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
35 #if !defined(__SOFTFP__) && !defined(__VFP_FP__) && !defined(__ARM_PCS)
36 #error FPA is not supported anymore
43 #include <machine/asm.h>
44 #include <machine/setjmp.h>
46 __FBSDID("$FreeBSD$");
49 * C library -- setjmp, longjmp
52 * will generate a "return(v)" from the last call to
54 * by restoring registers from the stack.
55 * The previous signal state is restored.
59 /* Block all signals and retrieve the old signal mask */
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)
67 ldr r1, .Lsetjmp_magic
72 GOT_INIT(r3, .Lsetjmp_got, .Lsetjmp_gotinit)
77 teq r2, #0 /* do we have a FPU? */
78 beq 1f /* no, don't save VFP registers */
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)
85 str r2, [r0, #(_JB_REG_FPSCR * 4)]
87 #endif /* __ARM_EABI__ */
89 str r1, [r0] /* store magic */
91 /* Store integer registers */
92 add r0, r0, #(_JB_REG_R4 * 4)
98 .word _JB_MAGIC_SETJMP
100 GOT_INITSYM(.Lsetjmp_got, .Lsetjmp_gotinit)
102 .word PIC_SYM(_libc_arm_fpu_present, GOTOFF)
103 #endif /* __ARM_EABI__ */
106 .weak _C_LABEL(longjmp)
107 .set _C_LABEL(longjmp), _C_LABEL(__longjmp)
110 ldr ip, .Lsetjmp_magic
111 bic r3, r2, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP)
115 /* Restore the signal mask. */
116 stmfd sp!, {r0-r2, r14}
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}
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)
129 ldr ip, [r0, #(_JB_REG_FPSCR * 4)]
132 #endif /* __ARM_EABI__ */
134 add r0, r0, #(_JB_REG_R4 * 4)
135 /* Restore integer registers */
138 /* Validate sp and r14 */
143 /* Set return value */
145 moveq r0, #0x00000001
148 /* validation failed, die die die. */
150 bl PIC_SYM(_C_LABEL(longjmperror), PLT)
151 bl PIC_SYM(_C_LABEL(abort), PLT)
152 b . - 8 /* Cannot get here */