diff options
Diffstat (limited to 'libc/arch-mips64/bionic/setjmp.S')
-rw-r--r-- | libc/arch-mips64/bionic/setjmp.S | 211 |
1 files changed, 211 insertions, 0 deletions
diff --git a/libc/arch-mips64/bionic/setjmp.S b/libc/arch-mips64/bionic/setjmp.S new file mode 100644 index 0000000..7c21195 --- /dev/null +++ b/libc/arch-mips64/bionic/setjmp.S @@ -0,0 +1,211 @@ +/* $OpenBSD: setjmp.S,v 1.5 2005/08/07 16:40:15 espie Exp $ */ + +/* + * Copyright (c) 2001-2002 Opsycon AB (www.opsycon.se / www.opsycon.com) + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. Neither the name of Opsycon AB nor the names of its contributors + * may be used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS + * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED + * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY + * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL + * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS + * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) + * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF + * SUCH DAMAGE. + * + */ + +#include <machine/asm.h> +#include <machine/regnum.h> +#include <machine/signal.h> + +/* + * setjmp, longjmp implementation for libc. this code depends + * on the layout of the struct sigcontext in machine/signal.h. + * + */ + +FRAMESZ= MKFSIZ(2,6) +A1OFF= FRAMESZ-4*REGSZ +A0OFF= FRAMESZ-3*REGSZ +GPOFF= FRAMESZ-2*REGSZ +RAOFF= FRAMESZ-1*REGSZ + +#define FPREG64_S(FPR, OFF, BASE) \ + swc1 FPR, OFF(BASE) ; \ + mfhc1 t0, FPR ; \ + sw t0, OFF+4(BASE) ; + +#define FPREG64_L(FPR, OFF, BASE) \ + lw t0, OFF+4(BASE) ; \ + lw t1, OFF(BASE) ; \ + mtc1 t1, FPR ; \ + mthc1 t0, FPR ; \ + +NON_LEAF(setjmp, FRAMESZ, ra) + .mask 0x80000000, RAOFF + PTR_SUBU sp, FRAMESZ # allocate stack frame + SETUP_GP64(GPOFF, setjmp) + SAVE_GP(GPOFF) + .set reorder + REG_S ra, RAOFF(sp) # save state + REG_S a0, A0OFF(sp) + + move a0, zero # get current signal mask + jal sigblock + + REG_L v1, A0OFF(sp) # v1 = jmpbuf + REG_S v0, SC_MASK(v1) # save sc_mask = sigblock(0) + + REG_L a0, A0OFF(sp) # restore jmpbuf + REG_L ra, RAOFF(sp) + REG_S ra, SC_PC(a0) # sc_pc = return address +#if defined(__mips64) + dli v0, 0xACEDBADE # sigcontext magic number +#else + li v0, 0xACEDBADE # sigcontext magic number +#endif + REG_S v0, SC_REGS+ZERO*REGSZ(a0) + REG_S s0, SC_REGS+S0*REGSZ(a0) + REG_S s1, SC_REGS+S1*REGSZ(a0) + REG_S s2, SC_REGS+S2*REGSZ(a0) + REG_S s3, SC_REGS+S3*REGSZ(a0) + REG_S s4, SC_REGS+S4*REGSZ(a0) + REG_S s5, SC_REGS+S5*REGSZ(a0) + REG_S s6, SC_REGS+S6*REGSZ(a0) + REG_S s7, SC_REGS+S7*REGSZ(a0) + REG_S s8, SC_REGS+S8*REGSZ(a0) + REG_L v0, GPOFF(sp) + REG_S v0, SC_REGS+GP*REGSZ(a0) + PTR_ADDU v0, sp, FRAMESZ + REG_S v0, SC_REGS+SP*REGSZ(a0) + +#if !defined(SOFTFLOAT) + li v0, 1 # be nice if we could tell + REG_S v0, SC_FPUSED(a0) # sc_fpused = 1 + cfc1 v0, $31 +#if _MIPS_FPSET == 32 + FPREG64_S($f20, SC_FPREGS+((F20-F0)*REGSZ_FP), a0) + FPREG64_S($f21, SC_FPREGS+((F21-F0)*REGSZ_FP), a0) + FPREG64_S($f22, SC_FPREGS+((F22-F0)*REGSZ_FP), a0) + FPREG64_S($f23, SC_FPREGS+((F23-F0)*REGSZ_FP), a0) + FPREG64_S($f24, SC_FPREGS+((F24-F0)*REGSZ_FP), a0) + FPREG64_S($f25, SC_FPREGS+((F25-F0)*REGSZ_FP), a0) + FPREG64_S($f26, SC_FPREGS+((F26-F0)*REGSZ_FP), a0) + FPREG64_S($f27, SC_FPREGS+((F27-F0)*REGSZ_FP), a0) + FPREG64_S($f28, SC_FPREGS+((F28-F0)*REGSZ_FP), a0) + FPREG64_S($f29, SC_FPREGS+((F29-F0)*REGSZ_FP), a0) + FPREG64_S($f30, SC_FPREGS+((F30-F0)*REGSZ_FP), a0) + FPREG64_S($f31, SC_FPREGS+((F31-F0)*REGSZ_FP), a0) +#else + swc1 $f20, SC_FPREGS+((F20-F0)*REGSZ_FP)(a0) + swc1 $f21, SC_FPREGS+((F21-F0)*REGSZ_FP)(a0) + swc1 $f22, SC_FPREGS+((F22-F0)*REGSZ_FP)(a0) + swc1 $f23, SC_FPREGS+((F23-F0)*REGSZ_FP)(a0) + swc1 $f24, SC_FPREGS+((F24-F0)*REGSZ_FP)(a0) + swc1 $f25, SC_FPREGS+((F25-F0)*REGSZ_FP)(a0) + swc1 $f26, SC_FPREGS+((F26-F0)*REGSZ_FP)(a0) + swc1 $f27, SC_FPREGS+((F27-F0)*REGSZ_FP)(a0) + swc1 $f28, SC_FPREGS+((F28-F0)*REGSZ_FP)(a0) + swc1 $f29, SC_FPREGS+((F29-F0)*REGSZ_FP)(a0) + swc1 $f30, SC_FPREGS+((F30-F0)*REGSZ_FP)(a0) + swc1 $f31, SC_FPREGS+((F31-F0)*REGSZ_FP)(a0) +#endif + REG_S v0, SC_FPREGS+((FSR-F0)*REGSZ)(a0) +#endif /* !SOFTFLOAT */ + move v0, zero + RESTORE_GP64 + PTR_ADDU sp, FRAMESZ + j ra + +botch: + jal longjmperror + jal abort + RESTORE_GP64 + PTR_ADDU sp, FRAMESZ +END(setjmp) + + +LEAF(longjmp, FRAMESZ) + PTR_SUBU sp, FRAMESZ + SETUP_GP64(GPOFF, longjmp) + SAVE_GP(GPOFF) + .set reorder + sw a1, A1OFF(sp) + sw a0, A0OFF(sp) + + lw a0, SC_MASK(a0) + jal sigsetmask + + lw a0, A0OFF(sp) + lw a1, A1OFF(sp) + + .set noreorder + REG_L v0, SC_REGS+ZERO*REGSZ(a0) + bne v0, 0xACEDBADE, botch # jump if error + REG_L ra, SC_PC(a0) + REG_L s0, SC_REGS+S0*REGSZ(a0) + REG_L s1, SC_REGS+S1*REGSZ(a0) + REG_L s2, SC_REGS+S2*REGSZ(a0) + REG_L s3, SC_REGS+S3*REGSZ(a0) + REG_L s4, SC_REGS+S4*REGSZ(a0) + REG_L s5, SC_REGS+S5*REGSZ(a0) + REG_L s6, SC_REGS+S6*REGSZ(a0) + REG_L s7, SC_REGS+S7*REGSZ(a0) + REG_L s8, SC_REGS+S8*REGSZ(a0) + REG_L gp, SC_REGS+GP*REGSZ(a0) + REG_L sp, SC_REGS+SP*REGSZ(a0) + +#if !defined(SOFTFLOAT) + REG_L v0, SC_FPREGS+((FSR-F0)*REGSZ)(a0) + ctc1 v0, $31 +#if _MIPS_FPSET == 32 + FPREG64_L($f20, SC_FPREGS+((F20-F0)*REGSZ_FP), a0) + FPREG64_L($f21, SC_FPREGS+((F21-F0)*REGSZ_FP), a0) + FPREG64_L($f22, SC_FPREGS+((F22-F0)*REGSZ_FP), a0) + FPREG64_L($f23, SC_FPREGS+((F23-F0)*REGSZ_FP), a0) + FPREG64_L($f24, SC_FPREGS+((F24-F0)*REGSZ_FP), a0) + FPREG64_L($f25, SC_FPREGS+((F25-F0)*REGSZ_FP), a0) + FPREG64_L($f26, SC_FPREGS+((F26-F0)*REGSZ_FP), a0) + FPREG64_L($f27, SC_FPREGS+((F27-F0)*REGSZ_FP), a0) + FPREG64_L($f28, SC_FPREGS+((F28-F0)*REGSZ_FP), a0) + FPREG64_L($f29, SC_FPREGS+((F29-F0)*REGSZ_FP), a0) + FPREG64_L($f30, SC_FPREGS+((F30-F0)*REGSZ_FP), a0) + FPREG64_L($f31, SC_FPREGS+((F31-F0)*REGSZ_FP), a0) +#else + lwc1 $f20, SC_FPREGS+((F20-F0)*REGSZ_FP)(a0) + lwc1 $f21, SC_FPREGS+((F21-F0)*REGSZ_FP)(a0) + lwc1 $f22, SC_FPREGS+((F22-F0)*REGSZ_FP)(a0) + lwc1 $f23, SC_FPREGS+((F23-F0)*REGSZ_FP)(a0) + lwc1 $f24, SC_FPREGS+((F24-F0)*REGSZ_FP)(a0) + lwc1 $f25, SC_FPREGS+((F25-F0)*REGSZ_FP)(a0) + lwc1 $f26, SC_FPREGS+((F26-F0)*REGSZ_FP)(a0) + lwc1 $f27, SC_FPREGS+((F27-F0)*REGSZ_FP)(a0) + lwc1 $f28, SC_FPREGS+((F28-F0)*REGSZ_FP)(a0) + lwc1 $f29, SC_FPREGS+((F29-F0)*REGSZ_FP)(a0) + lwc1 $f30, SC_FPREGS+((F30-F0)*REGSZ_FP)(a0) + lwc1 $f31, SC_FPREGS+((F31-F0)*REGSZ_FP)(a0) +#endif +#endif /* !SOFTFLOAT */ + bne a1, zero, 1f + nop + li a1, 1 # never return 0! +1: + j ra + move v0, a1 + +END(longjmp) |