_lwp.c revision 1.3 1 1.3 kleink /* $NetBSD: _lwp.c,v 1.3 2003/04/07 21:04:22 kleink Exp $ */
2 1.2 thorpej
3 1.2 thorpej /*-
4 1.2 thorpej * Copyright (c) 2002 The NetBSD Foundation, Inc.
5 1.2 thorpej * All rights reserved.
6 1.2 thorpej *
7 1.2 thorpej * Redistribution and use in source and binary forms, with or without
8 1.2 thorpej * modification, are permitted provided that the following conditions
9 1.2 thorpej * are met:
10 1.2 thorpej * 1. Redistributions of source code must retain the above copyright
11 1.2 thorpej * notice, this list of conditions and the following disclaimer.
12 1.2 thorpej * 2. Redistributions in binary form must reproduce the above copyright
13 1.2 thorpej * notice, this list of conditions and the following disclaimer in the
14 1.2 thorpej * documentation and/or other materials provided with the distribution.
15 1.2 thorpej * 3. All advertising materials mentioning features or use of this software
16 1.2 thorpej * must display the following acknowledgement:
17 1.2 thorpej * This product includes software developed by the NetBSD
18 1.2 thorpej * Foundation, Inc. and its contributors.
19 1.2 thorpej * 4. Neither the name of The NetBSD Foundation nor the names of its
20 1.2 thorpej * contributors may be used to endorse or promote products derived
21 1.2 thorpej * from this software without specific prior written permission.
22 1.2 thorpej *
23 1.2 thorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
24 1.2 thorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
25 1.2 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
26 1.2 thorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
27 1.2 thorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 1.2 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 1.2 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
30 1.2 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
31 1.2 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 1.2 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33 1.2 thorpej * POSSIBILITY OF SUCH DAMAGE.
34 1.2 thorpej */
35 1.2 thorpej
36 1.3 kleink #include "namespace.h"
37 1.2 thorpej #include <sys/types.h>
38 1.2 thorpej #include <ucontext.h>
39 1.2 thorpej #include <lwp.h>
40 1.2 thorpej #include <stdlib.h>
41 1.2 thorpej
42 1.2 thorpej void
43 1.2 thorpej _lwp_makecontext(ucontext_t *u, void (*start)(void *),
44 1.2 thorpej void *arg, void *private,
45 1.2 thorpej caddr_t stack_base, size_t stack_size)
46 1.2 thorpej {
47 1.2 thorpej __greg_t *gr;
48 1.2 thorpej unsigned long *sp;
49 1.2 thorpej
50 1.2 thorpej getcontext(u);
51 1.2 thorpej gr = u->uc_mcontext.__gregs;
52 1.2 thorpej
53 1.2 thorpej u->uc_link = NULL;
54 1.2 thorpej
55 1.2 thorpej u->uc_stack.ss_sp = stack_base;
56 1.2 thorpej u->uc_stack.ss_size = stack_size;
57 1.2 thorpej
58 1.2 thorpej sp = (ulong *)(stack_base + stack_size);
59 1.2 thorpej sp = (ulong *)((ulong)sp & ~0x0f);
60 1.2 thorpej
61 1.2 thorpej sp -= 8 + 8 + 6;
62 1.2 thorpej
63 1.2 thorpej sp[8] = (ulong)arg;
64 1.2 thorpej sp[14] = (ulong)sp - 2047;
65 1.2 thorpej sp[15] = (ulong)_lwp_exit - 8;
66 1.2 thorpej
67 1.2 thorpej sp = (ulong *)((caddr_t)sp - 2047);
68 1.2 thorpej
69 1.2 thorpej gr[_REG_PC] = (ulong) start;
70 1.2 thorpej gr[_REG_nPC] = (ulong) start + 4;
71 1.2 thorpej
72 1.2 thorpej gr[_REG_O0] = (ulong) arg;
73 1.2 thorpej gr[_REG_O6] = (ulong) sp;
74 1.2 thorpej gr[_REG_O7] = (ulong)_lwp_exit - 8;
75 1.2 thorpej }
76