Statistics
| Branch: | Revision:

root / prex-0.9.0 / usr / arch / arm / setjmp.S @ 03e9c04a

History | View | Annotate | Download (3.59 KB)

1
/*	$NetBSD: setjmp.S,v 1.5 2003/04/05 23:08:51 bjh21 Exp $	*/
2

    
3
/*
4
 * Copyright (c) 1997 Mark Brinicombe
5
 * All rights reserved.
6
 *
7
 * Redistribution and use in source and binary forms, with or without
8
 * modification, are permitted provided that the following conditions
9
 * are met:
10
 * 1. Redistributions of source code must retain the above copyright
11
 *    notice, this list of conditions and the following disclaimer.
12
 * 2. Redistributions in binary form must reproduce the above copyright
13
 *    notice, this list of conditions and the following disclaimer in the
14
 *    documentation and/or other materials provided with the distribution.
15
 * 3. All advertising materials mentioning features or use of this software
16
 *    must display the following acknowledgement:
17
 *	This product includes software developed by Mark Brinicombe
18
 * 4. Neither the name of the University nor the names of its contributors
19
 *    may be used to endorse or promote products derived from this software
20
 *    without specific prior written permission.
21
 *
22
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
23
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
26
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32
 * SUCH DAMAGE.
33
 */
34

    
35
#include <machine/asm.h>
36
#include <machine/setjmp.h>
37

    
38
/*
39
 * C library -- setjmp, longjmp
40
 *
41
 *	longjmp(a,v)
42
 * will generate a "return(v)" from the last call to
43
 *	setjmp(a)
44
 * by restoring registers from the stack.
45
 * The previous signal state is restored.
46
 */
47

    
48
ENTRY(setjmp)
49
	/* Block all signals and retrieve the old signal mask */
50
	stmfd	sp!, {r0, r14}
51
	mov	r0, #0x00000000
52

    
53
	bl	PIC_SYM(_C_LABEL(sigblock), PLT)
54
	mov	r1, r0
55

    
56
	ldmfd	sp!, {r0, r14}
57

    
58
	/* Store signal mask */
59
	str	r1, [r0, #((25-13) * 4)]
60

    
61
	ldr	r1, .Lsetjmp_magic
62
	str	r1, [r0], #4
63

    
64
#if 0 /* PREX */
65
#ifdef SOFTFLOAT
66
	add	r0, r0, #52
67
#else
68
	/* Store fp registers */
69
	sfm	f4, 4, [r0], #48
70
	/* Store fpsr */
71
	rfs	r1
72
	str	r1, [r0], #0x0004
73
#endif	/*SOFTFLOAT*/
74
#endif
75
	/* Store integer registers */
76
        stmia	r0, {r4-r14}
77
        mov	r0, #0x00000000
78
        mov	r15, r14
79

    
80
.Lsetjmp_magic:
81
	.word	_JB_MAGIC_SETJMP
82

    
83

    
84
ENTRY(longjmp)
85
	ldr	r2, .Lsetjmp_magic
86
	ldr	r3, [r0]
87
	teq	r2, r3
88
	bne	botch
89

    
90
	/* Fetch signal mask */
91
	ldr	r2, [r0, #((25-13) * 4)]
92

    
93
	/* Set signal mask */
94
	stmfd	sp!, {r0, r1, r14}
95
	sub	sp, sp, #4	/* align the stack */
96

    
97
	mov	r0, r2
98
	bl	PIC_SYM(_C_LABEL(sigsetmask), PLT)
99

    
100
	add	sp, sp, #4	/* unalign the stack */
101
	ldmfd	sp!, {r0, r1, r14}
102

    
103
	add	r0, r0, #4
104
#if 0 /* PREX */
105
#ifdef SOFTFLOAT
106
	add	r0, r0, #52
107
#else
108
	/* Restore fp registers */
109
	lfm	f4, 4, [r0], #48
110
	/* Restore FPSR */
111
	ldr	r4, [r0], #0x0004
112
	wfs	r4
113
#endif	/* SOFTFLOAT */
114
#endif
115
	/* Restore integer registers */
116
        ldmia	r0, {r4-r14}
117

    
118
	/* Validate sp and r14 */
119
	teq	sp, #0
120
	teqne	r14, #0
121
	beq	botch
122

    
123
	/* Set return value */
124

    
125
	mov	r0, r1
126
	teq	r0, #0x00000000
127
	moveq	r0, #0x00000001
128
#ifdef __ARM_26__
129
	mov	r15, r14
130
#else
131
	mov	r15, r14
132
#endif
133

    
134
	/* validation failed, die die die. */
135
botch:
136
#if 0 /* PREX */
137
	bl	PIC_SYM(_C_LABEL(longjmperror), PLT)
138
#endif
139
	bl	PIC_SYM(_C_LABEL(abort), PLT)
140
	b	. - 8		/* Cannot get here */