1/* $OpenBSD: setjmp.S,v 1.7 2011/11/22 21:13:30 guenther Exp $ */ 2 3/* 4 * Copyright (c) 2001-2002 Opsycon AB (www.opsycon.se / www.opsycon.com) 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 3. Neither the name of Opsycon AB nor the names of its contributors 15 * may be used to endorse or promote products derived from this software 16 * without specific prior written permission. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS 19 * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 20 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY 22 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28 * SUCH DAMAGE. 29 * 30 */ 31 32#include <sys/syscall.h> 33#include <machine/asm.h> 34#include <machine/regnum.h> 35#include <machine/signal.h> 36 37/* 38 * setjmp, longjmp implementation for libc. this code depends 39 * on the layout of the struct sigcontext in machine/signal.h. 40 * 41 */ 42 43FRAMESZ= MKFSIZ(2,6) 44A0OFF= FRAMESZ-3*REGSZ 45GPOFF= FRAMESZ-2*REGSZ 46RAOFF= FRAMESZ-1*REGSZ 47 48NON_LEAF(setjmp, FRAMESZ, ra) 49 .mask 0x80000000, RAOFF 50 PTR_SUBU sp, FRAMESZ # allocate stack frame 51 SETUP_GP64(GPOFF, setjmp) 52 .set reorder 53 REG_S ra, RAOFF(sp) # save state 54 REG_S a0, A0OFF(sp) 55 56 move a0, zero # get current signal mask 57 jal sigblock 58 59 REG_L v1, A0OFF(sp) # v1 = jmpbuf 60 REG_S v0, SC_MASK(v1) # save sc_mask = sigblock(0) 61 62 move a0, zero 63 PTR_ADD a1, sp, 0 # pointer to struct sigaltstack 64 jal _thread_sys_sigaltstack 65 66 REG_L a0, A0OFF(sp) # restore jmpbuf 67 ld v1, REGSZ(sp) # get old ss_onstack 68 and v1, v1, 1 # extract onstack flag 69 REG_S v1, SC_ONSTACK(a0) # save it in sc_onstack 70 REG_L ra, RAOFF(sp) 71 blt v0, zero, botch # check for sigaltstack() error 72 REG_S ra, SC_PC(a0) # sc_pc = return address 73#if defined(__mips64) 74 dli v0, 0xACEDBADE # sigcontext magic number 75#else 76 li v0, 0xACEDBADE # sigcontext magic number 77#endif 78 REG_S v0, SC_REGS+ZERO*REGSZ(a0) 79 REG_S s0, SC_REGS+S0*REGSZ(a0) 80 REG_S s1, SC_REGS+S1*REGSZ(a0) 81 REG_S s2, SC_REGS+S2*REGSZ(a0) 82 REG_S s3, SC_REGS+S3*REGSZ(a0) 83 REG_S s4, SC_REGS+S4*REGSZ(a0) 84 REG_S s5, SC_REGS+S5*REGSZ(a0) 85 REG_S s6, SC_REGS+S6*REGSZ(a0) 86 REG_S s7, SC_REGS+S7*REGSZ(a0) 87 REG_S s8, SC_REGS+S8*REGSZ(a0) 88 REG_L v0, GPOFF(sp) 89 REG_S v0, SC_REGS+GP*REGSZ(a0) 90 PTR_ADDU v0, sp, FRAMESZ 91 REG_S v0, SC_REGS+SP*REGSZ(a0) 92 li v0, 1 # be nice if we could tell 93 REG_S v0, SC_FPUSED(a0) # sc_fpused = 1 94 cfc1 v0, $31 95#if _MIPS_FPSET == 32 96 sdc1 $f20, SC_FPREGS+((F20-F0)*REGSZ)(a0) 97 sdc1 $f21, SC_FPREGS+((F21-F0)*REGSZ)(a0) 98 sdc1 $f22, SC_FPREGS+((F22-F0)*REGSZ)(a0) 99 sdc1 $f23, SC_FPREGS+((F23-F0)*REGSZ)(a0) 100 sdc1 $f24, SC_FPREGS+((F24-F0)*REGSZ)(a0) 101 sdc1 $f25, SC_FPREGS+((F25-F0)*REGSZ)(a0) 102 sdc1 $f26, SC_FPREGS+((F26-F0)*REGSZ)(a0) 103 sdc1 $f27, SC_FPREGS+((F27-F0)*REGSZ)(a0) 104 sdc1 $f28, SC_FPREGS+((F28-F0)*REGSZ)(a0) 105 sdc1 $f29, SC_FPREGS+((F29-F0)*REGSZ)(a0) 106 sdc1 $f30, SC_FPREGS+((F30-F0)*REGSZ)(a0) 107 sdc1 $f31, SC_FPREGS+((F31-F0)*REGSZ)(a0) 108#else 109 swc1 $f20, SC_FPREGS+((F20-F0)*REGSZ)(a0) 110 swc1 $f21, SC_FPREGS+((F21-F0)*REGSZ)(a0) 111 swc1 $f22, SC_FPREGS+((F22-F0)*REGSZ)(a0) 112 swc1 $f23, SC_FPREGS+((F23-F0)*REGSZ)(a0) 113 swc1 $f24, SC_FPREGS+((F24-F0)*REGSZ)(a0) 114 swc1 $f25, SC_FPREGS+((F25-F0)*REGSZ)(a0) 115 swc1 $f26, SC_FPREGS+((F26-F0)*REGSZ)(a0) 116 swc1 $f27, SC_FPREGS+((F27-F0)*REGSZ)(a0) 117 swc1 $f28, SC_FPREGS+((F28-F0)*REGSZ)(a0) 118 swc1 $f29, SC_FPREGS+((F29-F0)*REGSZ)(a0) 119 swc1 $f30, SC_FPREGS+((F30-F0)*REGSZ)(a0) 120 swc1 $f31, SC_FPREGS+((F31-F0)*REGSZ)(a0) 121#endif 122 REG_S v0, SC_FPREGS+((FSR-F0)*REGSZ)(a0) 123 move v0, zero 124 RESTORE_GP64 125 PTR_ADDU sp, FRAMESZ 126 j ra 127 128botch: 129 jal longjmperror 130 jal abort 131 RESTORE_GP64 132 PTR_ADDU sp, FRAMESZ 133END(setjmp) 134 135 136FRAMESZ= MKFSIZ(1,1) 137GPOFF= FRAMESZ-2*REGSZ 138 139LEAF(longjmp, FRAMESZ) 140 PTR_SUBU sp, FRAMESZ 141 SETUP_GP64(GPOFF, longjmp) 142 .set reorder 143 bne a1, zero, 1f 144 li a1, 1 # never return 0! 1451: 146 REG_S a1, SC_REGS+V0*REGSZ(a0) 147 li v0, SYS_sigreturn 148 syscall 149 150 jal longjmperror 151 jal abort 152 RESTORE_GP64 153 PTR_ADDU sp, FRAMESZ 154END(longjmp) 155