2 * Copyright (c) Olivier Houchard
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
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.
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
27 #include <machine/asm.h>
28 __FBSDID("$FreeBSD$");
31 * int thr_setcontext(mcontext_t *mcp, intptr_t val, intptr_t *loc)
33 * Restores the context in mcp.
35 * Returns 0 if there are no errors; -1 otherwise
38 .weak _C_LABEL(_thr_setcontext)
39 .set _C_LABEL(_thr_setcontext), _C_LABEL(__thr_setcontext)
41 ENTRY(__thr_setcontext)
42 /* Check for NULL pointer. */
48 ldr r1, [r0, #(16 * 4)] /* CPSR */
55 * int thr_getcontext(mcontext_t *mcp);
57 * Returns -1 if there is an error, 0 no errors; 1 upon return
58 * from a setcontext().
60 .weak _C_LABEL(_thr_getcontext)
61 .set _C_LABEL(_thr_getcontext), _C_LABEL(__thr_getcontext)
63 ENTRY(__thr_getcontext)
64 /* Check for NULL pointer. */
70 str r1, [r0] /* Return 1 from setcontext */
71 str lr, [r0, #(15 * 4)] /* PC */
73 str r1, [r0, #(16 * 4)] /* CPSR */
74 mov r0, #0 /* Return 0. */
78 add sp, r2, r3 /* Stack addr + size. */