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