| Raghu Gandham | 405b802 | 2012-07-25 18:16:42 -0700 | [diff] [blame] | 1 | /*	$OpenBSD: _setjmp.S,v 1.4 2005/08/07 16:40:15 espie Exp $ */ | 
|  | 2 |  | 
|  | 3 | /* | 
|  | 4 | * Copyright (c) 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 <machine/asm.h> | 
|  | 33 | #include <machine/regnum.h> | 
| David 'Digit' Turner | c1b44ec | 2012-10-17 19:10:11 +0200 | [diff] [blame] | 34 | #include <machine/signal.h> | 
| Raghu Gandham | 405b802 | 2012-07-25 18:16:42 -0700 | [diff] [blame] | 35 |  | 
|  | 36 | /* | 
|  | 37 | * _setjmp, _longjmp (not restoring signal state) | 
|  | 38 | * | 
|  | 39 | * XXX FPSET should probably be taken from SR setting. hmmm... | 
|  | 40 | *  GPOFF and FRAMESIZE must be the same for both _setjmp and _longjmp! | 
|  | 41 | * | 
|  | 42 | */ | 
|  | 43 |  | 
|  | 44 | FRAMESZ= MKFSIZ(0,4) | 
|  | 45 | GPOFF= FRAMESZ-2*REGSZ | 
|  | 46 |  | 
|  | 47 | #define FPREG64_S(FPR, OFF, BASE)       \ | 
|  | 48 | swc1    FPR, OFF(BASE)  ;       \ | 
|  | 49 | mfhc1   t0, FPR         ;       \ | 
|  | 50 | sw      t0, OFF+4(BASE) ; | 
|  | 51 |  | 
|  | 52 | #define FPREG64_L(FPR, OFF, BASE)       \ | 
|  | 53 | lw      t0, OFF+4(BASE) ;       \ | 
|  | 54 | lw      t1, OFF(BASE)   ;       \ | 
|  | 55 | mtc1    t1, FPR         ;       \ | 
|  | 56 | mthc1   t0, FPR         ;       \ | 
|  | 57 |  | 
|  | 58 | LEAF(_setjmp, FRAMESZ) | 
|  | 59 | PTR_SUBU sp, FRAMESZ | 
|  | 60 | SETUP_GP64(GPOFF, _setjmp) | 
|  | 61 | SAVE_GP(GPOFF) | 
|  | 62 | .set	noreorder | 
|  | 63 | #if defined(__mips64) | 
|  | 64 | dli	v0, 0xACEDBADE			# sigcontext magic number | 
|  | 65 | #else | 
|  | 66 | li	v0, 0xACEDBADE			# sigcontext magic number | 
|  | 67 | #endif | 
|  | 68 | REG_S	v0, SC_REGS+ZERO*REGSZ(a0) | 
|  | 69 | REG_S	s0, SC_REGS+S0*REGSZ(a0) | 
|  | 70 | REG_S	s1, SC_REGS+S1*REGSZ(a0) | 
|  | 71 | REG_S	s2, SC_REGS+S2*REGSZ(a0) | 
|  | 72 | REG_S	s3, SC_REGS+S3*REGSZ(a0) | 
|  | 73 | REG_S	s4, SC_REGS+S4*REGSZ(a0) | 
|  | 74 | REG_S	s5, SC_REGS+S5*REGSZ(a0) | 
|  | 75 | REG_S	s6, SC_REGS+S6*REGSZ(a0) | 
|  | 76 | REG_S	s7, SC_REGS+S7*REGSZ(a0) | 
|  | 77 | REG_S	s8, SC_REGS+S8*REGSZ(a0) | 
|  | 78 | REG_L	v0, GPOFF(sp) | 
|  | 79 | REG_S	v0, SC_REGS+GP*REGSZ(a0) | 
|  | 80 | PTR_ADDU v0, sp, FRAMESZ | 
|  | 81 | REG_S	v0, SC_REGS+SP*REGSZ(a0) | 
|  | 82 | REG_S	ra, SC_PC(a0) | 
|  | 83 |  | 
|  | 84 | #if !defined(SOFTFLOAT) | 
|  | 85 | li	v0, 1				# be nice if we could tell | 
|  | 86 | REG_S	v0, SC_FPUSED(a0)		# sc_fpused = 1 | 
|  | 87 | cfc1	v0, $31 | 
|  | 88 | #if _MIPS_FPSET == 32 | 
|  | 89 | FPREG64_S($f20, SC_FPREGS+((F20-F0)*REGSZ_FP), a0) | 
|  | 90 | FPREG64_S($f21, SC_FPREGS+((F21-F0)*REGSZ_FP), a0) | 
|  | 91 | FPREG64_S($f22, SC_FPREGS+((F22-F0)*REGSZ_FP), a0) | 
|  | 92 | FPREG64_S($f23, SC_FPREGS+((F23-F0)*REGSZ_FP), a0) | 
|  | 93 | FPREG64_S($f24, SC_FPREGS+((F24-F0)*REGSZ_FP), a0) | 
|  | 94 | FPREG64_S($f25, SC_FPREGS+((F25-F0)*REGSZ_FP), a0) | 
|  | 95 | FPREG64_S($f26, SC_FPREGS+((F26-F0)*REGSZ_FP), a0) | 
|  | 96 | FPREG64_S($f27, SC_FPREGS+((F27-F0)*REGSZ_FP), a0) | 
|  | 97 | FPREG64_S($f28, SC_FPREGS+((F28-F0)*REGSZ_FP), a0) | 
|  | 98 | FPREG64_S($f29, SC_FPREGS+((F29-F0)*REGSZ_FP), a0) | 
|  | 99 | FPREG64_S($f30, SC_FPREGS+((F30-F0)*REGSZ_FP), a0) | 
|  | 100 | FPREG64_S($f31, SC_FPREGS+((F31-F0)*REGSZ_FP), a0) | 
|  | 101 | #else | 
|  | 102 | swc1    $f20, SC_FPREGS+((F20-F0)*REGSZ_FP)(a0) | 
|  | 103 | swc1    $f21, SC_FPREGS+((F21-F0)*REGSZ_FP)(a0) | 
|  | 104 | swc1    $f22, SC_FPREGS+((F22-F0)*REGSZ_FP)(a0) | 
|  | 105 | swc1    $f23, SC_FPREGS+((F23-F0)*REGSZ_FP)(a0) | 
|  | 106 | swc1    $f24, SC_FPREGS+((F24-F0)*REGSZ_FP)(a0) | 
|  | 107 | swc1    $f25, SC_FPREGS+((F25-F0)*REGSZ_FP)(a0) | 
|  | 108 | swc1    $f26, SC_FPREGS+((F26-F0)*REGSZ_FP)(a0) | 
|  | 109 | swc1    $f27, SC_FPREGS+((F27-F0)*REGSZ_FP)(a0) | 
|  | 110 | swc1    $f28, SC_FPREGS+((F28-F0)*REGSZ_FP)(a0) | 
|  | 111 | swc1    $f29, SC_FPREGS+((F29-F0)*REGSZ_FP)(a0) | 
|  | 112 | swc1    $f30, SC_FPREGS+((F30-F0)*REGSZ_FP)(a0) | 
|  | 113 | swc1    $f31, SC_FPREGS+((F31-F0)*REGSZ_FP)(a0) | 
|  | 114 | #endif | 
|  | 115 | REG_S	v0, SC_FPREGS+((FSR-F0)*REGSZ)(a0) | 
|  | 116 | #endif /* !SOFTFLOAT */ | 
|  | 117 | RESTORE_GP64 | 
|  | 118 | PTR_ADDU sp, FRAMESZ | 
|  | 119 | j	ra | 
|  | 120 | move	v0, zero | 
|  | 121 | END(_setjmp) | 
|  | 122 |  | 
|  | 123 | LEAF(_longjmp, FRAMESZ) | 
|  | 124 | PTR_SUBU sp, FRAMESZ | 
|  | 125 | SETUP_GP64(GPOFF, _longjmp) | 
|  | 126 | SAVE_GP(GPOFF) | 
|  | 127 | .set    noreorder | 
|  | 128 | REG_L	v0, SC_REGS+ZERO*REGSZ(a0) | 
|  | 129 | bne	v0, 0xACEDBADE, botch		# jump if error | 
|  | 130 | REG_L	ra, SC_PC(a0) | 
|  | 131 | REG_L	v0, SC_FPREGS+((FSR-F0)*REGSZ)(a0) | 
|  | 132 | REG_L	s0, SC_REGS+S0*REGSZ(a0) | 
|  | 133 | REG_L	s1, SC_REGS+S1*REGSZ(a0) | 
|  | 134 | REG_L	s2, SC_REGS+S2*REGSZ(a0) | 
|  | 135 | REG_L	s3, SC_REGS+S3*REGSZ(a0) | 
|  | 136 | REG_L	s4, SC_REGS+S4*REGSZ(a0) | 
|  | 137 | REG_L	s5, SC_REGS+S5*REGSZ(a0) | 
|  | 138 | REG_L	s6, SC_REGS+S6*REGSZ(a0) | 
|  | 139 | REG_L	s7, SC_REGS+S7*REGSZ(a0) | 
|  | 140 | REG_L	s8, SC_REGS+S8*REGSZ(a0) | 
|  | 141 | REG_L	gp, SC_REGS+GP*REGSZ(a0) | 
|  | 142 | REG_L	sp, SC_REGS+SP*REGSZ(a0) | 
|  | 143 | #if !defined(SOFTFLOAT) | 
|  | 144 | ctc1	v0, $31 | 
|  | 145 | #if _MIPS_FPSET == 32 | 
|  | 146 | FPREG64_L($f20, SC_FPREGS+((F20-F0)*REGSZ_FP), a0) | 
|  | 147 | FPREG64_L($f21, SC_FPREGS+((F21-F0)*REGSZ_FP), a0) | 
|  | 148 | FPREG64_L($f22, SC_FPREGS+((F22-F0)*REGSZ_FP), a0) | 
|  | 149 | FPREG64_L($f23, SC_FPREGS+((F23-F0)*REGSZ_FP), a0) | 
|  | 150 | FPREG64_L($f24, SC_FPREGS+((F24-F0)*REGSZ_FP), a0) | 
|  | 151 | FPREG64_L($f25, SC_FPREGS+((F25-F0)*REGSZ_FP), a0) | 
|  | 152 | FPREG64_L($f26, SC_FPREGS+((F26-F0)*REGSZ_FP), a0) | 
|  | 153 | FPREG64_L($f27, SC_FPREGS+((F27-F0)*REGSZ_FP), a0) | 
|  | 154 | FPREG64_L($f28, SC_FPREGS+((F28-F0)*REGSZ_FP), a0) | 
|  | 155 | FPREG64_L($f29, SC_FPREGS+((F29-F0)*REGSZ_FP), a0) | 
|  | 156 | FPREG64_L($f30, SC_FPREGS+((F30-F0)*REGSZ_FP), a0) | 
|  | 157 | FPREG64_L($f31, SC_FPREGS+((F31-F0)*REGSZ_FP), a0) | 
|  | 158 | #else | 
|  | 159 | lwc1    $f20, SC_FPREGS+((F20-F0)*REGSZ_FP)(a0) | 
|  | 160 | lwc1    $f21, SC_FPREGS+((F21-F0)*REGSZ_FP)(a0) | 
|  | 161 | lwc1    $f22, SC_FPREGS+((F22-F0)*REGSZ_FP)(a0) | 
|  | 162 | lwc1    $f23, SC_FPREGS+((F23-F0)*REGSZ_FP)(a0) | 
|  | 163 | lwc1    $f24, SC_FPREGS+((F24-F0)*REGSZ_FP)(a0) | 
|  | 164 | lwc1    $f25, SC_FPREGS+((F25-F0)*REGSZ_FP)(a0) | 
|  | 165 | lwc1    $f26, SC_FPREGS+((F26-F0)*REGSZ_FP)(a0) | 
|  | 166 | lwc1    $f27, SC_FPREGS+((F27-F0)*REGSZ_FP)(a0) | 
|  | 167 | lwc1    $f28, SC_FPREGS+((F28-F0)*REGSZ_FP)(a0) | 
|  | 168 | lwc1    $f29, SC_FPREGS+((F29-F0)*REGSZ_FP)(a0) | 
|  | 169 | lwc1    $f30, SC_FPREGS+((F30-F0)*REGSZ_FP)(a0) | 
|  | 170 | lwc1    $f31, SC_FPREGS+((F31-F0)*REGSZ_FP)(a0) | 
|  | 171 | #endif | 
|  | 172 | #endif /* !SOFTFLOAT */ | 
|  | 173 | bne	a1, zero, 1f | 
|  | 174 | nop | 
|  | 175 | li	a1, 1			# never return 0! | 
|  | 176 | 1: | 
|  | 177 | j	ra | 
|  | 178 | move	v0, a1 | 
|  | 179 |  | 
|  | 180 | botch: | 
|  | 181 | jal	longjmperror | 
|  | 182 | nop | 
|  | 183 | jal	abort | 
|  | 184 | nop | 
|  | 185 | RESTORE_GP64 | 
|  | 186 | PTR_ADDU sp, FRAMESZ | 
|  | 187 | END(_longjmp) | 
|  | 188 |  |