1251392Sandrew/* $NetBSD: setjmp.S,v 1.14 2013/04/19 13:45:45 matt Exp $ */ 2129202Scognet 3129202Scognet/* 4129202Scognet * Copyright (c) 1997 Mark Brinicombe 5129202Scognet * All rights reserved. 6129202Scognet * 7129202Scognet * Redistribution and use in source and binary forms, with or without 8129202Scognet * modification, are permitted provided that the following conditions 9129202Scognet * are met: 10129202Scognet * 1. Redistributions of source code must retain the above copyright 11129202Scognet * notice, this list of conditions and the following disclaimer. 12129202Scognet * 2. Redistributions in binary form must reproduce the above copyright 13129202Scognet * notice, this list of conditions and the following disclaimer in the 14129202Scognet * documentation and/or other materials provided with the distribution. 15129202Scognet * 3. All advertising materials mentioning features or use of this software 16129202Scognet * must display the following acknowledgement: 17129202Scognet * This product includes software developed by Mark Brinicombe 18129202Scognet * 4. Neither the name of the University nor the names of its contributors 19129202Scognet * may be used to endorse or promote products derived from this software 20129202Scognet * without specific prior written permission. 21129202Scognet * 22129202Scognet * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 23129202Scognet * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 24129202Scognet * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 25129202Scognet * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 26129202Scognet * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 27129202Scognet * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 28129202Scognet * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 29129202Scognet * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 30129202Scognet * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 31129202Scognet * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 32129202Scognet * SUCH DAMAGE. 33129202Scognet */ 34129202Scognet 35251392Sandrew#if !defined(__SOFTFP__) && !defined(__VFP_FP__) && !defined(__ARM_PCS) 36251392Sandrew#error FPA is not supported anymore 37251392Sandrew#endif 38251392Sandrew 39251514Sandrew .fpu vfp 40251514Sandrew 41129202Scognet#include <machine/asm.h> 42251392Sandrew#include <machine/setjmp.h> 43251392Sandrew 44129202Scognet__FBSDID("$FreeBSD: releng/11.0/lib/libc/arm/gen/setjmp.S 288373 2015-09-29 16:09:58Z kib $"); 45251392Sandrew 46129202Scognet/* 47129202Scognet * C library -- setjmp, longjmp 48129202Scognet * 49129202Scognet * longjmp(a,v) 50129202Scognet * will generate a "return(v)" from the last call to 51129202Scognet * setjmp(a) 52129202Scognet * by restoring registers from the stack. 53129202Scognet * The previous signal state is restored. 54129202Scognet */ 55129202Scognet 56129202ScognetENTRY(setjmp) 57129202Scognet /* Block all signals and retrieve the old signal mask */ 58129202Scognet stmfd sp!, {r0, r14} 59251392Sandrew add r2, r0, #(_JB_SIGMASK * 4) /* oset */ 60251392Sandrew mov r1, #0x00000000 /* set */ 61251392Sandrew mov r0, #0x00000001 /* SIG_BLOCK */ 62135685Scognet bl PIC_SYM(_C_LABEL(sigprocmask), PLT) 63129202Scognet ldmfd sp!, {r0, r14} 64129202Scognet 65129202Scognet ldr r1, .Lsetjmp_magic 66251514Sandrew 67251514Sandrew ldr r2, .Lfpu_present 68251514Sandrew#ifdef PIC 69251514Sandrew GOT_INIT(r3, .Lsetjmp_got, .Lsetjmp_gotinit) 70251514Sandrew ldr r2, [r2, r3] 71251514Sandrew#else 72251514Sandrew ldr r2, [r2] 73251514Sandrew#endif 74251514Sandrew teq r2, #0 /* do we have a FPU? */ 75251514Sandrew beq 1f /* no, don't save VFP registers */ 76251514Sandrew 77251514Sandrew orr r1, r1, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP) 78251514Sandrew /* change magic to VFP magic */ 79251514Sandrew add r2, r0, #(_JB_REG_D8 * 4) 80251514Sandrew vstmia r2, {d8-d15} 81251514Sandrew vmrs r2, fpscr 82251514Sandrew str r2, [r0, #(_JB_REG_FPSCR * 4)] 83251514Sandrew1: 84251514Sandrew 85251392Sandrew str r1, [r0] /* store magic */ 86129202Scognet 87129202Scognet /* Store integer registers */ 88251392Sandrew add r0, r0, #(_JB_REG_R4 * 4) 89282816Sandrew#ifndef __thumb__ 90129202Scognet stmia r0, {r4-r14} 91282816Sandrew#else 92282816Sandrew stmia r0, {r4-r12} 93282816Sandrew str r13, [r0, #((_JB_REG_R13 - _JB_REG_R4) * 4)] 94282816Sandrew str r14, [r0, #((_JB_REG_R14 - _JB_REG_R4) * 4)] 95282816Sandrew#endif 96129202Scognet mov r0, #0x00000000 97137464Scognet RET 98129202Scognet 99129202Scognet.Lsetjmp_magic: 100129202Scognet .word _JB_MAGIC_SETJMP 101251514Sandrew GOT_INITSYM(.Lsetjmp_got, .Lsetjmp_gotinit) 102251514Sandrew.Lfpu_present: 103251514Sandrew .word PIC_SYM(_libc_arm_fpu_present, GOTOFF) 104270882SianEND(setjmp) 105129202Scognet 106129202Scognet.weak _C_LABEL(longjmp) 107129202Scognet.set _C_LABEL(longjmp), _C_LABEL(__longjmp) 108129202ScognetENTRY(__longjmp) 109251392Sandrew ldr r2, [r0] 110251392Sandrew ldr ip, .Lsetjmp_magic 111251514Sandrew bic r3, r2, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP) 112251514Sandrew teq r3, ip 113251392Sandrew bne .Lbotch 114129202Scognet 115251392Sandrew /* Restore the signal mask. */ 116251392Sandrew stmfd sp!, {r0-r2, r14} 117251392Sandrew mov r2, #0x00000000 118251392Sandrew add r1, r0, #(_JB_SIGMASK * 4) /* Signal mask */ 119251392Sandrew mov r0, #3 /* SIG_SETMASK */ 120135685Scognet bl PIC_SYM(_C_LABEL(sigprocmask), PLT) 121251392Sandrew ldmfd sp!, {r0-r2, r14} 122129202Scognet 123251514Sandrew tst r2, #(_JB_MAGIC_SETJMP ^ _JB_MAGIC_SETJMP_VFP) 124251514Sandrew /* is this a VFP magic? */ 125251514Sandrew beq 1f /* no, don't restore VFP */ 126251514Sandrew add ip, r0, #(_JB_REG_D8 * 4) 127251514Sandrew vldmia ip, {d8-d15} 128251514Sandrew ldr ip, [r0, #(_JB_REG_FPSCR * 4)] 129251514Sandrew vmsr fpscr, ip 130251514Sandrew1: 131251514Sandrew 132251392Sandrew add r0, r0, #(_JB_REG_R4 * 4) 133129202Scognet /* Restore integer registers */ 134282816Sandrew#ifndef __thumb__ 135129202Scognet ldmia r0, {r4-r14} 136282816Sandrew#else 137282816Sandrew ldmia r0, {r4-r12} 138282816Sandrew ldr r13, [r0, #((_JB_REG_R13 - _JB_REG_R4) * 4)] 139282816Sandrew ldr r14, [r0, #((_JB_REG_R14 - _JB_REG_R4) * 4)] 140282816Sandrew#endif 141129202Scognet 142129202Scognet /* Validate sp and r14 */ 143129202Scognet teq sp, #0 144282816Sandrew it ne 145129202Scognet teqne r14, #0 146282816Sandrew it eq 147251392Sandrew beq .Lbotch 148129202Scognet 149129202Scognet /* Set return value */ 150251392Sandrew movs r0, r1 151282816Sandrew it eq 152129202Scognet moveq r0, #0x00000001 153137464Scognet RET 154129202Scognet 155129202Scognet /* validation failed, die die die. */ 156251392Sandrew.Lbotch: 157129202Scognet bl PIC_SYM(_C_LABEL(longjmperror), PLT) 158129202Scognet bl PIC_SYM(_C_LABEL(abort), PLT) 159282816Sandrew1: b 1b /* Cannot get here */ 160270882SianEND(__longjmp) 161288373Skib 162288373Skib .section .note.GNU-stack,"",%progbits 163