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#if !defined(_STANDALONE)
40	.fpu	vfp
41#endif
42
43#include <machine/asm.h>
44#include <machine/setjmp.h>
45/*
46 * C library -- _setjmp, _longjmp
47 *
48 *	_longjmp(a,v)
49 * will generate a "return(v)" from the last call to
50 *	_setjmp(a)
51 * by restoring registers from the stack.
52 * The previous signal state is NOT restored.
53 *
54 * Note: r0 is the return value
55 *       r1-r3,ip are scratch registers in functions
56 */
57
58ENTRY(_setjmp)
59	ldr	r1, .L_setjmp_magic
60
61#if !defined(_STANDALONE) && !defined(SOFTFLOAT_FOR_GCC)
62	add	r2, r0, #(_JB_REG_D8 * 4)
63	vstmia	r2, {d8-d15}
64	vmrs	r2, fpscr
65	str	r2, [r0, #(_JB_REG_FPSCR * 4)]
66#endif /* !_STANDALONE && !SOFTFLOAT_FOR_GCC */
67
68	str	r1, [r0]
69
70	add	r0, r0, #(_JB_REG_R4 * 4)
71	/* Store integer registers */
72#ifndef __thumb__
73        stmia	r0, {r4-r14}
74#else
75	stmia	r0, {r4-r12}
76	str	r13, [r0, #((_JB_REG_R13 - _JB_REG_R4) * 4)]
77	str	r14, [r0, #((_JB_REG_R14 - _JB_REG_R4) * 4)]
78#endif
79
80        mov	r0, #0x00000000
81	RET
82END(_setjmp)
83
84.L_setjmp_magic:
85	.word	_JB_MAGIC__SETJMP
86
87WEAK_ALIAS(___longjmp, _longjmp)
88ENTRY(_longjmp)
89	ldr	r2, [r0]			/* get magic from jmp_buf */
90	ldr	ip, .L_setjmp_magic		/* load magic */
91	teq	ip, r2				/* magic correct? */
92	bne	botch				/*   no, botch */
93
94#if !defined(_STANDALONE) && !defined(SOFTFLOAT_FOR_GCC)
95	add	ip, r0, #(_JB_REG_D8 * 4)
96	vldmia	ip, {d8-d15}
97	ldr	ip, [r0, #(_JB_REG_FPSCR * 4)]
98	vmsr	fpscr, ip
99#endif /* !_STANDALONE && !SOFTFLOAT_FOR_GCC */
100
101	add	r0, r0, #(_JB_REG_R4 * 4)
102       	/* Restore integer registers */
103#ifndef __thumb__
104        ldmia	r0, {r4-r14}
105#else
106	ldmia	r0, {r4-r12}
107	ldr	r13, [r0, #((_JB_REG_R13 - _JB_REG_R4) * 4)]
108	ldr	r14, [r0, #((_JB_REG_R14 - _JB_REG_R4) * 4)]
109#endif
110
111	/* Validate sp and r14 */
112	teq	sp, #0
113	it	ne
114	teqne	r14, #0
115	it	eq
116	beq	botch
117
118	/* Set return value */
119	movs	r0, r1
120	it	eq
121	moveq	r0, #0x00000001
122	RET
123
124	/* validation failed, die die die. */
125botch:
126#if !defined(_STANDALONE)
127	bl	PIC_SYM(_C_LABEL(longjmperror), PLT)
128	bl	PIC_SYM(_C_LABEL(abort), PLT)
1291:	b	1b		/* Cannot get here */
130#else
131	b	.
132#endif
133END(_longjmp)
134
135	.section .note.GNU-stack,"",%progbits
136