xref: /optee_os/lib/libutils/isoc/arch/arm/setjmp_a64.S (revision 1bb929836182ecb96d2d9d268daa807c67596396)
1*1bb92983SJerome Forissier/* SPDX-License-Identifier: BSD-3-Clause */
20c81fcd6SJens Wiklander/*
30c81fcd6SJens Wiklander   Copyright (c) 2011, 2012 ARM Ltd
40c81fcd6SJens Wiklander   All rights reserved.
50c81fcd6SJens Wiklander
60c81fcd6SJens Wiklander   Redistribution and use in source and binary forms, with or without
70c81fcd6SJens Wiklander   modification, are permitted provided that the following conditions
80c81fcd6SJens Wiklander   are met:
90c81fcd6SJens Wiklander   1. Redistributions of source code must retain the above copyright
100c81fcd6SJens Wiklander      notice, this list of conditions and the following disclaimer.
110c81fcd6SJens Wiklander   2. Redistributions in binary form must reproduce the above copyright
120c81fcd6SJens Wiklander      notice, this list of conditions and the following disclaimer in the
130c81fcd6SJens Wiklander      documentation and/or other materials provided with the distribution.
140c81fcd6SJens Wiklander   3. The name of the company may not be used to endorse or promote
150c81fcd6SJens Wiklander      products derived from this software without specific prior written
160c81fcd6SJens Wiklander      permission.
170c81fcd6SJens Wiklander
180c81fcd6SJens Wiklander   THIS SOFTWARE IS PROVIDED BY ARM LTD ``AS IS'' AND ANY EXPRESS OR IMPLIED
190c81fcd6SJens Wiklander   WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
200c81fcd6SJens Wiklander   MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
210c81fcd6SJens Wiklander   IN NO EVENT SHALL ARM LTD BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
220c81fcd6SJens Wiklander   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
230c81fcd6SJens Wiklander   TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
240c81fcd6SJens Wiklander   PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
250c81fcd6SJens Wiklander   LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
260c81fcd6SJens Wiklander   NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
270c81fcd6SJens Wiklander   SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
280c81fcd6SJens Wiklander */
290c81fcd6SJens Wiklander
300c81fcd6SJens Wiklander#define GPR_LAYOUT			\
310c81fcd6SJens Wiklander	REG_PAIR (x19, x20,  0);	\
320c81fcd6SJens Wiklander	REG_PAIR (x21, x22, 16);	\
330c81fcd6SJens Wiklander	REG_PAIR (x23, x24, 32);	\
340c81fcd6SJens Wiklander	REG_PAIR (x25, x26, 48);	\
350c81fcd6SJens Wiklander	REG_PAIR (x27, x28, 64);	\
360c81fcd6SJens Wiklander	REG_PAIR (x29, x30, 80);	\
370c81fcd6SJens Wiklander	REG_ONE (x16,      96)
380c81fcd6SJens Wiklander
390c81fcd6SJens Wiklander#define FPR_LAYOUT			\
400c81fcd6SJens Wiklander	REG_PAIR ( d8,  d9, 112);	\
410c81fcd6SJens Wiklander	REG_PAIR (d10, d11, 128);	\
420c81fcd6SJens Wiklander	REG_PAIR (d12, d13, 144);	\
430c81fcd6SJens Wiklander	REG_PAIR (d14, d15, 160);
440c81fcd6SJens Wiklander
450c81fcd6SJens Wiklander// int setjmp (jmp_buf)
460c81fcd6SJens Wiklander	.global	setjmp
470c81fcd6SJens Wiklander	.type	setjmp, %function
480c81fcd6SJens Wiklandersetjmp:
490c81fcd6SJens Wiklander	mov	x16, sp
500c81fcd6SJens Wiklander#define REG_PAIR(REG1, REG2, OFFS)	stp REG1, REG2, [x0, OFFS]
510c81fcd6SJens Wiklander#define REG_ONE(REG1, OFFS)		str REG1, [x0, OFFS]
520c81fcd6SJens Wiklander	GPR_LAYOUT
530c81fcd6SJens Wiklander	FPR_LAYOUT
540c81fcd6SJens Wiklander#undef REG_PAIR
550c81fcd6SJens Wiklander#undef REG_ONE
560c81fcd6SJens Wiklander	mov	w0, #0
570c81fcd6SJens Wiklander	ret
580c81fcd6SJens Wiklander	.size	setjmp, .-setjmp
590c81fcd6SJens Wiklander
600c81fcd6SJens Wiklander// void longjmp (jmp_buf, int) __attribute__ ((noreturn))
610c81fcd6SJens Wiklander	.global	longjmp
620c81fcd6SJens Wiklander	.type	longjmp, %function
630c81fcd6SJens Wiklanderlongjmp:
640c81fcd6SJens Wiklander#define REG_PAIR(REG1, REG2, OFFS)	ldp REG1, REG2, [x0, OFFS]
650c81fcd6SJens Wiklander#define REG_ONE(REG1, OFFS)		ldr REG1, [x0, OFFS]
660c81fcd6SJens Wiklander	GPR_LAYOUT
670c81fcd6SJens Wiklander	FPR_LAYOUT
680c81fcd6SJens Wiklander#undef REG_PAIR
690c81fcd6SJens Wiklander#undef REG_ONE
700c81fcd6SJens Wiklander	mov	sp, x16
710c81fcd6SJens Wiklander	cmp	w1, #0
720c81fcd6SJens Wiklander	cinc	w0, w1, eq
730c81fcd6SJens Wiklander	// use br not ret, as ret is guaranteed to mispredict
740c81fcd6SJens Wiklander	br	x30
750c81fcd6SJens Wiklander	.size	longjmp, .-longjmp
76