1/*	$OpenBSD: _setjmp.S,v 1.6 2022/12/24 10:49:19 kettenis Exp $	*/
2/*-
3 * Copyright (c) 2014 Andrew Turner
4 * Copyright (c) 2014 The FreeBSD Foundation
5 * All rights reserved.
6 *
7 * Portions of this software were developed by Andrew Turner
8 * under sponsorship from the FreeBSD Foundation
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 *    notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 *    notice, this list of conditions and the following disclaimer in the
17 *    documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
23 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * SUCH DAMAGE.
30 *
31 */
32
33#include "DEFS.h"
34#include <machine/setjmp.h>
35
36ENTRY(_setjmp)
37	RETGUARD_SETUP(_setjmp, x15)
38	/* Store the magic value and stack pointer */
39	movz	x8, #(_JB_MAGIC__SETJMP & 0xffff)
40	movk	x8, #(_JB_MAGIC__SETJMP >> 16), lsl #16
41	mov	x9, sp
42	stp	x8, x9, [x0], #16
43
44	/* Store the general purpose registers and lr */
45	stp	x19, x20, [x0], #16
46	stp	x21, x22, [x0], #16
47	stp	x23, x24, [x0], #16
48	stp	x25, x26, [x0], #16
49	stp	x27, x28, [x0], #16
50	stp	x29, x30, [x0], #16
51
52#ifndef _STANDALONE
53	/* Store the vfp registers */
54	stp	d8, d9, [x0], #16
55	stp	d10, d11, [x0], #16
56	stp	d12, d13, [x0], #16
57	stp	d14, d15, [x0], #16
58	mrs	x1, fpcr
59	str	x1, [x0]
60#endif
61
62	/* Return value */
63	mov	x0, #0
64	RETGUARD_CHECK(_setjmp, x15)
65	ret
66END_STRONG(_setjmp)
67
68ENTRY(_longjmp)
69	RETGUARD_SYMBOL(_longjmp)
70	RETGUARD_LOAD_RANDOM(_longjmp, x15)
71	/* Check the magic value */
72	ldr	x8, [x0], #8
73	movz	x9, #(_JB_MAGIC__SETJMP & 0xffff)
74	movk	x9, #(_JB_MAGIC__SETJMP >> 16), lsl #16
75	cmp	x8, x9
76	b.ne	.Lbotch
77
78	/* Restore the stack pointer */
79	ldr	x8, [x0], #8
80	mov	sp, x8
81
82	/* Restore the general purpose registers and lr */
83	ldp	x19, x20, [x0], #16
84	ldp	x21, x22, [x0], #16
85	ldp	x23, x24, [x0], #16
86	ldp	x25, x26, [x0], #16
87	ldp	x27, x28, [x0], #16
88	ldp	x29, x30, [x0], #16
89	RETGUARD_CALC_COOKIE(x15)
90
91#ifndef _STANDALONE
92	/* Restore the vfp registers */
93	ldp	d8, d9, [x0], #16
94	ldp	d10, d11, [x0], #16
95	ldp	d12, d13, [x0], #16
96	ldp	d14, d15, [x0], #16
97	ldr	x2, [x0]
98	msr	fpcr, x2
99#endif
100
101	/* Load the return value */
102	cmp	w1, #0
103	csinc	w0, w1, wzr, ne
104	RETGUARD_CHECK(_longjmp, x15)
105	ret
106
107.Lbotch:
108	bl	_HIDDEN(abort)
109END_STRONG(_longjmp)
110