1 1.7 martin /* $NetBSD: _lwp.c,v 1.7 2012/03/17 20:48:58 martin 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 * 16 1.2 thorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 1.2 thorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 1.2 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 1.2 thorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 1.2 thorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 1.2 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 1.2 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 1.2 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 1.2 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 1.2 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.2 thorpej * POSSIBILITY OF SUCH DAMAGE. 27 1.2 thorpej */ 28 1.2 thorpej 29 1.4 lukem #include <sys/cdefs.h> 30 1.4 lukem #if defined(LIBC_SCCS) && !defined(lint) 31 1.7 martin __RCSID("$NetBSD: _lwp.c,v 1.7 2012/03/17 20:48:58 martin Exp $"); 32 1.4 lukem #endif /* LIBC_SCCS and not lint */ 33 1.4 lukem 34 1.3 kleink #include "namespace.h" 35 1.2 thorpej #include <sys/types.h> 36 1.2 thorpej #include <ucontext.h> 37 1.2 thorpej #include <lwp.h> 38 1.2 thorpej #include <stdlib.h> 39 1.2 thorpej 40 1.2 thorpej void 41 1.2 thorpej _lwp_makecontext(ucontext_t *u, void (*start)(void *), 42 1.2 thorpej void *arg, void *private, 43 1.2 thorpej caddr_t stack_base, size_t stack_size) 44 1.2 thorpej { 45 1.2 thorpej __greg_t *gr; 46 1.2 thorpej unsigned long *sp; 47 1.2 thorpej 48 1.2 thorpej getcontext(u); 49 1.2 thorpej gr = u->uc_mcontext.__gregs; 50 1.2 thorpej 51 1.2 thorpej u->uc_link = NULL; 52 1.2 thorpej 53 1.2 thorpej u->uc_stack.ss_sp = stack_base; 54 1.2 thorpej u->uc_stack.ss_size = stack_size; 55 1.2 thorpej 56 1.7 martin /*LINTED*/ 57 1.2 thorpej sp = (ulong *)(stack_base + stack_size); 58 1.2 thorpej sp = (ulong *)((ulong)sp & ~0x0f); 59 1.2 thorpej 60 1.2 thorpej sp -= 8 + 8 + 6; 61 1.2 thorpej 62 1.2 thorpej sp[8] = (ulong)arg; 63 1.2 thorpej sp[14] = (ulong)sp - 2047; 64 1.2 thorpej sp[15] = (ulong)_lwp_exit - 8; 65 1.2 thorpej 66 1.7 martin /*LINTED*/ 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.6 joerg gr[_REG_G7] = (ulong)private; 76 1.2 thorpej } 77