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$");
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)
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 */
153END(__longjmp)
154