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