_setjmp.S revision 1.6.50.2
1 1.6.50.2 yamt /* $NetBSD: _setjmp.S,v 1.6.50.2 2013/01/23 00:05:21 yamt Exp $ */ 2 1.1 bjh21 3 1.1 bjh21 /* 4 1.1 bjh21 * Copyright (c) 1997 Mark Brinicombe 5 1.1 bjh21 * All rights reserved. 6 1.1 bjh21 * 7 1.1 bjh21 * Redistribution and use in source and binary forms, with or without 8 1.1 bjh21 * modification, are permitted provided that the following conditions 9 1.1 bjh21 * are met: 10 1.1 bjh21 * 1. Redistributions of source code must retain the above copyright 11 1.1 bjh21 * notice, this list of conditions and the following disclaimer. 12 1.1 bjh21 * 2. Redistributions in binary form must reproduce the above copyright 13 1.1 bjh21 * notice, this list of conditions and the following disclaimer in the 14 1.1 bjh21 * documentation and/or other materials provided with the distribution. 15 1.1 bjh21 * 3. All advertising materials mentioning features or use of this software 16 1.1 bjh21 * must display the following acknowledgement: 17 1.1 bjh21 * This product includes software developed by Mark Brinicombe 18 1.1 bjh21 * 4. Neither the name of the University nor the names of its contributors 19 1.1 bjh21 * may be used to endorse or promote products derived from this software 20 1.1 bjh21 * without specific prior written permission. 21 1.1 bjh21 * 22 1.1 bjh21 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 23 1.1 bjh21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24 1.1 bjh21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25 1.1 bjh21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 26 1.1 bjh21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 27 1.1 bjh21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 28 1.1 bjh21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 29 1.1 bjh21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 30 1.1 bjh21 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 31 1.1 bjh21 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32 1.1 bjh21 * SUCH DAMAGE. 33 1.1 bjh21 */ 34 1.1 bjh21 35 1.6.50.2 yamt #if !defined(__SOFTFP__) && !defined(__VFP_FP__) 36 1.6.50.2 yamt #error FPA is not supported anymore 37 1.6.50.2 yamt #endif 38 1.6.50.2 yamt 39 1.1 bjh21 #include <machine/asm.h> 40 1.1 bjh21 #include <machine/setjmp.h> 41 1.1 bjh21 42 1.1 bjh21 /* 43 1.1 bjh21 * C library -- _setjmp, _longjmp 44 1.1 bjh21 * 45 1.1 bjh21 * _longjmp(a,v) 46 1.1 bjh21 * will generate a "return(v)" from the last call to 47 1.1 bjh21 * _setjmp(a) 48 1.1 bjh21 * by restoring registers from the stack. 49 1.1 bjh21 * The previous signal state is NOT restored. 50 1.1 bjh21 * 51 1.1 bjh21 * Note: r0 is the return value 52 1.1 bjh21 * r1-r3 are scratch registers in functions 53 1.1 bjh21 */ 54 1.1 bjh21 55 1.1 bjh21 ENTRY(_setjmp) 56 1.4 thorpej ldr r1, .L_setjmp_magic 57 1.6.50.2 yamt str r1, [r0] 58 1.6.50.2 yamt 59 1.6.50.2 yamt #ifndef __SOFTFP__ 60 1.6.50.2 yamt add r1, r0, #(_JB_REG_D8 * 4) 61 1.6.50.2 yamt vstmia r1, {d8-d15} 62 1.6.50.2 yamt vmrs r1, fpscr 63 1.6.50.2 yamt str r1, [r0, #(_JB_REG_FPSCR * 4)] 64 1.6.50.2 yamt #endif 65 1.6.50.2 yamt 66 1.6.50.2 yamt add r0, r0, #(_JB_REG_R4 * 4) 67 1.1 bjh21 /* Store integer registers */ 68 1.1 bjh21 stmia r0, {r4-r14} 69 1.1 bjh21 70 1.1 bjh21 mov r0, #0x00000000 71 1.6 rearnsha RET 72 1.1 bjh21 73 1.4 thorpej .L_setjmp_magic: 74 1.6.50.2 yamt #ifdef __SOFTFP__ 75 1.1 bjh21 .word _JB_MAGIC__SETJMP 76 1.6.50.2 yamt #else 77 1.6.50.2 yamt .word _JB_MAGIC__SETJMP_VFP 78 1.6.50.2 yamt #endif 79 1.1 bjh21 80 1.1 bjh21 ENTRY(_longjmp) 81 1.4 thorpej ldr r2, .L_setjmp_magic 82 1.6.50.2 yamt ldr r3, [r0] 83 1.1 bjh21 teq r2, r3 84 1.1 bjh21 bne botch 85 1.1 bjh21 86 1.6.50.2 yamt #ifndef __SOFTFP__ 87 1.6.50.2 yamt add r1, r0, #(_JB_REG_D8 * 4) 88 1.6.50.2 yamt vldmia r1, {d8-d15} 89 1.6.50.2 yamt ldr r1, [r0, #(_JB_REG_FPSCR * 4)] 90 1.6.50.2 yamt vmsr fpscr, r1 91 1.6.50.2 yamt #endif 92 1.6.50.2 yamt 93 1.6.50.2 yamt add r0, r0, #(_JB_REG_R4 * 4) 94 1.1 bjh21 /* Restore integer registers */ 95 1.1 bjh21 ldmia r0, {r4-r14} 96 1.1 bjh21 97 1.3 chris /* Validate sp and r14 */ 98 1.3 chris teq sp, #0 99 1.3 chris teqne r14, #0 100 1.1 bjh21 beq botch 101 1.1 bjh21 102 1.1 bjh21 /* Set return value */ 103 1.1 bjh21 mov r0, r1 104 1.1 bjh21 teq r0, #0x00000000 105 1.1 bjh21 moveq r0, #0x00000001 106 1.6 rearnsha RET 107 1.1 bjh21 108 1.1 bjh21 /* validation failed, die die die. */ 109 1.1 bjh21 botch: 110 1.2 matt bl PIC_SYM(_C_LABEL(longjmperror), PLT) 111 1.2 matt bl PIC_SYM(_C_LABEL(abort), PLT) 112 1.1 bjh21 b . - 8 /* Cannot get here */ 113
Indexes created Fri Oct 03 17:10:05 GMT 2025