1*0a6a1f1dSLionel Sambuc /* $NetBSD: _lwp.c,v 1.1 2014/09/19 17:36:25 matt Exp $ */
2*0a6a1f1dSLionel Sambuc
3*0a6a1f1dSLionel Sambuc /*
4*0a6a1f1dSLionel Sambuc * Copyright (c) 2001 Wasabi Systems, Inc.
5*0a6a1f1dSLionel Sambuc * All rights reserved.
6*0a6a1f1dSLionel Sambuc *
7*0a6a1f1dSLionel Sambuc * Written by Allen Briggs for Wasabi Systems, Inc.
8*0a6a1f1dSLionel Sambuc *
9*0a6a1f1dSLionel Sambuc * Redistribution and use in source and binary forms, with or without
10*0a6a1f1dSLionel Sambuc * modification, are permitted provided that the following conditions
11*0a6a1f1dSLionel Sambuc * are met:
12*0a6a1f1dSLionel Sambuc * 1. Redistributions of source code must retain the above copyright
13*0a6a1f1dSLionel Sambuc * notice, this list of conditions and the following disclaimer.
14*0a6a1f1dSLionel Sambuc * 2. Redistributions in binary form must reproduce the above copyright
15*0a6a1f1dSLionel Sambuc * notice, this list of conditions and the following disclaimer in the
16*0a6a1f1dSLionel Sambuc * documentation and/or other materials provided with the distribution.
17*0a6a1f1dSLionel Sambuc * 3. All advertising materials mentioning features or use of this software
18*0a6a1f1dSLionel Sambuc * must display the following acknowledgement:
19*0a6a1f1dSLionel Sambuc * This product includes software developed for the NetBSD Project by
20*0a6a1f1dSLionel Sambuc * Wasabi Systems, Inc.
21*0a6a1f1dSLionel Sambuc * 4. The name of Wasabi Systems, Inc. may not be used to endorse
22*0a6a1f1dSLionel Sambuc * or promote products derived from this software without specific prior
23*0a6a1f1dSLionel Sambuc * written permission.
24*0a6a1f1dSLionel Sambuc *
25*0a6a1f1dSLionel Sambuc * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
26*0a6a1f1dSLionel Sambuc * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
27*0a6a1f1dSLionel Sambuc * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
28*0a6a1f1dSLionel Sambuc * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
29*0a6a1f1dSLionel Sambuc * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
30*0a6a1f1dSLionel Sambuc * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
31*0a6a1f1dSLionel Sambuc * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
32*0a6a1f1dSLionel Sambuc * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
33*0a6a1f1dSLionel Sambuc * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
34*0a6a1f1dSLionel Sambuc * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
35*0a6a1f1dSLionel Sambuc * POSSIBILITY OF SUCH DAMAGE.
36*0a6a1f1dSLionel Sambuc */
37*0a6a1f1dSLionel Sambuc
38*0a6a1f1dSLionel Sambuc #include <sys/cdefs.h>
39*0a6a1f1dSLionel Sambuc #if defined(LIBC_SCCS) && !defined(lint)
40*0a6a1f1dSLionel Sambuc __RCSID("$NetBSD: _lwp.c,v 1.1 2014/09/19 17:36:25 matt Exp $");
41*0a6a1f1dSLionel Sambuc #endif /* LIBC_SCCS and not lint */
42*0a6a1f1dSLionel Sambuc
43*0a6a1f1dSLionel Sambuc #include "namespace.h"
44*0a6a1f1dSLionel Sambuc #include <sys/param.h>
45*0a6a1f1dSLionel Sambuc #include <sys/types.h>
46*0a6a1f1dSLionel Sambuc #include <ucontext.h>
47*0a6a1f1dSLionel Sambuc #include <lwp.h>
48*0a6a1f1dSLionel Sambuc #include <stdlib.h>
49*0a6a1f1dSLionel Sambuc
50*0a6a1f1dSLionel Sambuc void
_lwp_makecontext(ucontext_t * u,void (* start)(void *),void * arg,void * tcb,caddr_t stack_base,size_t stack_size)51*0a6a1f1dSLionel Sambuc _lwp_makecontext(ucontext_t *u, void (*start)(void *), void *arg,
52*0a6a1f1dSLionel Sambuc void *tcb, caddr_t stack_base, size_t stack_size)
53*0a6a1f1dSLionel Sambuc {
54*0a6a1f1dSLionel Sambuc uintptr_t sp;
55*0a6a1f1dSLionel Sambuc
56*0a6a1f1dSLionel Sambuc getcontext(u);
57*0a6a1f1dSLionel Sambuc u->uc_link = NULL;
58*0a6a1f1dSLionel Sambuc
59*0a6a1f1dSLionel Sambuc u->uc_stack.ss_sp = stack_base;
60*0a6a1f1dSLionel Sambuc u->uc_stack.ss_size = stack_size;
61*0a6a1f1dSLionel Sambuc
62*0a6a1f1dSLionel Sambuc sp = (uintptr_t)stack_base + stack_size;
63*0a6a1f1dSLionel Sambuc sp -= STACK_ALIGNBYTES + 1;
64*0a6a1f1dSLionel Sambuc sp &= ~STACK_ALIGNBYTES;
65*0a6a1f1dSLionel Sambuc
66*0a6a1f1dSLionel Sambuc u->uc_mcontext.__gregs[_REG_RV] = (uintptr_t)arg; /* arg1 */
67*0a6a1f1dSLionel Sambuc u->uc_mcontext.__gregs[_REG_SP] = (uintptr_t)sp; /* stack */
68*0a6a1f1dSLionel Sambuc u->uc_mcontext.__gregs[_REG_RA] = (uintptr_t)_lwp_exit; /* RA */
69*0a6a1f1dSLionel Sambuc u->uc_mcontext.__gregs[_REG_PC] = (uintptr_t)start; /* PC */
70*0a6a1f1dSLionel Sambuc u->uc_mcontext.__gregs[_REG_TP] =
71*0a6a1f1dSLionel Sambuc (uintptr_t)tcb + TLS_TP_OFFSET + sizeof(struct tls_tcb);
72*0a6a1f1dSLionel Sambuc }
73