setjmp.S revision 1.4 1 /*.$NetBSD: setjmp.S,v 1.4 2021/10/07 06:44:18 skrll Exp $.*/
2
3 /*-
4 * Copyright (c) 2014 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Matt Thomas of 3am Software Foundry.
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 NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32 #include <machine/asm.h>
33 #include "assym.h"
34
35 /*
36 * C library -- setjmp, longjmp
37 *
38 * longjmp(a,v)
39 * will generate a "return(v)" from the last call to
40 * setjmp(a)
41 * by restoring registers from the stack.
42 * The previous signal state is restored.
43 */
44
45 .section .rodata.cst8,"aM",@progbits,8
46 .align 3
47 .L_MAGIC:
48 .xword _JB_MAGIC_AARCH64_SETJMP
49
50 ENTRY(__setjmp14)
51 adrp x7, .L_MAGIC
52 ldr x7, [x7, #:lo12:.L_MAGIC]
53
54 mov x3, sp
55 stp x7, x3, [x0, #_JB_MAGIC]
56
57 stp x19, x20, [x0, #_JB_X19]
58 stp x21, x22, [x0, #_JB_X21]
59 stp x23, x24, [x0, #_JB_X23]
60 stp x25, x26, [x0, #_JB_X25]
61 stp x27, x28, [x0, #_JB_X27]
62 stp x29, x30, [x0, #_JB_X29]
63
64 stp d8, d9, [x0, #_JB_D8]
65 stp d10, d11, [x0, #_JB_D10]
66 stp d12, d13, [x0, #_JB_D12]
67 stp d14, d15, [x0, #_JB_D14]
68
69 /* Get the signal mask. */
70 add x2, x0, #_JB_SIGMASK
71 mov x1, #0
72 mov x0, #0
73
74 stp x29, x30, [sp, #-16]!
75 mov x29, sp
76 bl _C_LABEL(__sigprocmask14)
77 ldp x29, x30, [sp], #16
78
79 mov x0, xzr
80 ret
81 END(__setjmp14)
82
83 ENTRY(__longjmp14)
84 adrp x7, .L_MAGIC
85 ldr x7, [x7, #:lo12:.L_MAGIC]
86 ldp x2, x3, [x0, #_JB_MAGIC]
87 cmp x2, x7
88 b.ne .Lbotch
89
90 ldp x4, x5, [x0, #_JB_X29]
91 cbz x3, .Lbotch
92 cbz x5, .Lbotch
93
94 ldp x19, x20, [x0, #_JB_X19]
95 ldp x21, x22, [x0, #_JB_X21]
96 ldp x23, x24, [x0, #_JB_X23]
97 ldp x25, x26, [x0, #_JB_X25]
98 ldp x27, x28, [x0, #_JB_X27]
99
100 ldp d8, d9, [x0, #_JB_D8]
101 ldp d10, d11, [x0, #_JB_D10]
102 ldp d12, d13, [x0, #_JB_D12]
103 ldp d14, d15, [x0, #_JB_D14]
104
105 sub sp, x3, #32
106
107 stp x4, x5, [sp, #16]
108 str x1, [sp, #8]
109 add x29, sp, #16
110
111 mov x2, #0
112 add x1, x0, #_JB_SIGMASK
113 mov x0, #3 /* SIG_SETMASK */
114 bl _C_LABEL(__sigprocmask14)
115
116 ldp x29, x30, [sp, #16]
117 ldr x1, [sp, #8]
118 add sp, sp, #32
119
120 cmp x1, #0
121 csinc x0, x1, xzr, ne
122 ret
123
124 /* validation failed, die die die. */
125 .Lbotch:
126 bl _C_LABEL(longjmperror)
127 bl _C_LABEL(abort)
128 1: b 1b /* Cannot get here */
129 END(__longjmp14)
130