context.S revision 129206 
1/*
2 * Copyright (c) Olivier Houchard
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 *    notice, this list of conditions and the following disclaimer.
10 * 2. Neither the name of the author nor the names of its contributors
11 *    may be used to endorse or promote products derived from this software
12 *    without specific prior written permission.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27#include <machine/asm.h>
28__FBSDID("$FreeBSD: head/lib/libkse/arch/arm/arm/context.S 129206 2004-05-14 12:21:29Z cognet $");
29
30/*
31 * int thr_setcontext(mcontext_t *mcp, intptr_t val, intptr_t *loc)
32 *
33 * Restores the context in mcp.
34 *
35 * Returns 0 if there are no errors; -1 otherwise
36 */
37
38.weak _C_LABEL(_thr_setcontext)
39.set _C_LABEL(_thr_setcontext), _C_LABEL(__thr_setcontext)
40
41ENTRY(__thr_setcontext)
42/* Check for NULL pointer. */
43	cmp 	r0, #0
44	moveq 	r0, #-1
45	moveq 	pc, lr
46	add	ip, r0, #8
47	ldmia	ip, {r2-r12}
48	cmp	r2, #0
49	str	r1, [r2]
50	add	ip, r0, #4
51	str	ip, [r1] /* Restore r1. */
52	add	ip, r0, #64
53	msr	cpsr, ip
54	add	ip, r0, #52
55	mov	r0, #0 /* Return 0. */
56	ldr	sp, [ip] /* Restore stack pointer. */
57	mov	pc, lr /* Return. */
58	/* XXX: FP bits ? */
59
60/*
61 * int thr_getcontext(mcontext_t *mcp);
62 *
63 * Returns -1 if there is an error, 0 no errors; 1 upon return
64 * from a setcontext().
65 */
66.weak _C_LABEL(_thr_getcontext)
67.set _C_LABEL(_thr_getcontext), _C_LABEL(__thr_getcontext)
68
69ENTRY(__thr_getcontext)
70/* Check for NULL pointer. */
71	cmp	r0, #0
72	moveq	r0, #-1
73	moveq	pc, lr
74	stmia	r0, {r0-r13}
75	mov	r0, #0 /* Return 0. */
76	mov	pc, lr
77
78ENTRY(_arm_enter_uts)
79	add	r4, r2, r3 /* Stack addr + size. */
80	mov	lr, pc
81	mov	pc, r1
82