1/*-
2 * Copyright (c) 2015 Ruslan Bukin <br@bsdpad.com>
3 * All rights reserved.
4 *
5 * Portions of this software were developed by SRI International and the
6 * University of Cambridge Computer Laboratory under DARPA/AFRL contract
7 * FA8750-10-C-0237 ("CTSRD"), as part of the DARPA CRASH research programme.
8 *
9 * Portions of this software were developed by the University of Cambridge
10 * Computer Laboratory as part of the CTSRD Project, with support from the
11 * UK Higher Education Innovation Fund (HEIF).
12 *
13 * Redistribution and use in source and binary forms, with or without
14 * modification, are permitted provided that the following conditions
15 * are met:
16 * 1. Redistributions of source code must retain the above copyright
17 *    notice, this list of conditions and the following disclaimer.
18 * 2. Redistributions in binary form must reproduce the above copyright
19 *    notice, this list of conditions and the following disclaimer in the
20 *    documentation and/or other materials provided with the distribution.
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#include <machine/asm.h>
36__FBSDID("$FreeBSD$");
37
38#include <machine/setjmp.h>
39
40ENTRY(_setjmp)
41	/* Store the magic value and stack pointer */
42	la	t0, .Lmagic
43	ld	t0, 0(t0)
44	sd	t0, (0 * 8)(a0)
45	sd	sp, (1 * 8)(a0)
46	addi	a0, a0, (2 * 8)
47
48	/* Store the general purpose registers and ra */
49	sd	s0, (0 * 8)(a0)
50	sd	s1, (1 * 8)(a0)
51	sd	s2, (2 * 8)(a0)
52	sd	s3, (3 * 8)(a0)
53	sd	s4, (4 * 8)(a0)
54	sd	s5, (5 * 8)(a0)
55	sd	s6, (6 * 8)(a0)
56	sd	s7, (7 * 8)(a0)
57	sd	s8, (8 * 8)(a0)
58	sd	s9, (9 * 8)(a0)
59	sd	s10, (10 * 8)(a0)
60	sd	s11, (11 * 8)(a0)
61	sd	ra, (12 * 8)(a0)
62	addi	a0, a0, (13 * 8)
63
64#ifndef _STANDALONE
65#if 0
66	/* RISCVTODO */
67	/* Store the vfp registers */
68	fsq	fs0, (0 * 16)(a0)
69	fsq	fs1, (1 * 16)(a0)
70	fsq	fs2, (2 * 16)(a0)
71	fsq	fs3, (3 * 16)(a0)
72	fsq	fs4, (4 * 16)(a0)
73	fsq	fs5, (5 * 16)(a0)
74	fsq	fs6, (6 * 16)(a0)
75	fsq	fs7, (7 * 16)(a0)
76	fsq	fs8, (8 * 16)(a0)
77	fsq	fs9, (9 * 16)(a0)
78	fsq	fs10, (10 * 16)(a0)
79	fsq	fs11, (11 * 16)(a0)
80	addi	a0, a0, (12 * 16)
81#endif
82#endif
83
84	/* Return value */
85	li	a0, 0
86	ret
87	.align	3
88.Lmagic:
89	.quad	_JB_MAGIC__SETJMP
90END(_setjmp)
91
92ENTRY(_longjmp)
93	/* Check the magic value */
94	ld	t0, 0(a0)
95	la	t1, .Lmagic
96	ld	t1, 0(t1)
97	bne	t0, t1, botch
98
99	/* Restore the stack pointer */
100	ld	t0, 8(a0)
101	mv	sp, t0
102	addi	a0, a0, (2 * 8)
103
104	/* Restore the general purpose registers and ra */
105	ld	s0, (0 * 8)(a0)
106	ld	s1, (1 * 8)(a0)
107	ld	s2, (2 * 8)(a0)
108	ld	s3, (3 * 8)(a0)
109	ld	s4, (4 * 8)(a0)
110	ld	s5, (5 * 8)(a0)
111	ld	s6, (6 * 8)(a0)
112	ld	s7, (7 * 8)(a0)
113	ld	s8, (8 * 8)(a0)
114	ld	s9, (9 * 8)(a0)
115	ld	s10, (10 * 8)(a0)
116	ld	s11, (11 * 8)(a0)
117	ld	ra, (12 * 8)(a0)
118	addi	a0, a0, (13 * 8)
119
120#ifndef _STANDALONE
121#if 0
122	/* RISCVTODO */
123	/* Restore the vfp registers */
124	flq	fs0, (0 * 16)(a0)
125	flq	fs1, (1 * 16)(a0)
126	flq	fs2, (2 * 16)(a0)
127	flq	fs3, (3 * 16)(a0)
128	flq	fs4, (4 * 16)(a0)
129	flq	fs5, (5 * 16)(a0)
130	flq	fs6, (6 * 16)(a0)
131	flq	fs7, (7 * 16)(a0)
132	flq	fs8, (8 * 16)(a0)
133	flq	fs9, (9 * 16)(a0)
134	flq	fs10, (10 * 16)(a0)
135	flq	fs11, (11 * 16)(a0)
136	addi	a0, a0, (12 * 16)
137#endif
138#endif
139
140	/* Load the return value */
141	mv	a0, a1
142	ret
143
144botch:
145#ifdef _STANDALONE
146	j	botch
147#else
148	call	_C_LABEL(longjmperror)
149	call	_C_LABEL(abort)
150#endif
151END(_longjmp)
152