makecontext.c revision 1.4.8.2 1 1.4.8.2 martin /* $NetBSD: makecontext.c,v 1.4.8.2 2008/04/28 20:22:57 martin Exp $ */
2 1.4.8.2 martin
3 1.4.8.2 martin /*-
4 1.4.8.2 martin * Copyright (c) 1999 The NetBSD Foundation, Inc.
5 1.4.8.2 martin * All rights reserved.
6 1.4.8.2 martin *
7 1.4.8.2 martin * This code is derived from software contributed to The NetBSD Foundation
8 1.4.8.2 martin * by Klaus Klein.
9 1.4.8.2 martin *
10 1.4.8.2 martin * Redistribution and use in source and binary forms, with or without
11 1.4.8.2 martin * modification, are permitted provided that the following conditions
12 1.4.8.2 martin * are met:
13 1.4.8.2 martin * 1. Redistributions of source code must retain the above copyright
14 1.4.8.2 martin * notice, this list of conditions and the following disclaimer.
15 1.4.8.2 martin * 2. Redistributions in binary form must reproduce the above copyright
16 1.4.8.2 martin * notice, this list of conditions and the following disclaimer in the
17 1.4.8.2 martin * documentation and/or other materials provided with the distribution.
18 1.4.8.2 martin *
19 1.4.8.2 martin * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.4.8.2 martin * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.4.8.2 martin * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.4.8.2 martin * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.4.8.2 martin * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.4.8.2 martin * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.4.8.2 martin * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.4.8.2 martin * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.4.8.2 martin * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.4.8.2 martin * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.4.8.2 martin * POSSIBILITY OF SUCH DAMAGE.
30 1.4.8.2 martin */
31 1.4.8.2 martin
32 1.4.8.2 martin #include <sys/cdefs.h>
33 1.4.8.2 martin #if defined(LIBC_SCCS) && !defined(lint)
34 1.4.8.2 martin __RCSID("$NetBSD: makecontext.c,v 1.4.8.2 2008/04/28 20:22:57 martin Exp $");
35 1.4.8.2 martin #endif
36 1.4.8.2 martin
37 1.4.8.2 martin #include <inttypes.h>
38 1.4.8.2 martin #include <stddef.h>
39 1.4.8.2 martin #include <ucontext.h>
40 1.4.8.2 martin #include "extern.h"
41 1.4.8.2 martin
42 1.4.8.2 martin #if __STDC__
43 1.4.8.2 martin #include <stdarg.h>
44 1.4.8.2 martin #else
45 1.4.8.2 martin #include <varargs.h>
46 1.4.8.2 martin #endif
47 1.4.8.2 martin
48 1.4.8.2 martin
49 1.4.8.2 martin void
50 1.4.8.2 martin #if __STDC__
51 1.4.8.2 martin makecontext(ucontext_t *ucp, void (*func)(void), int argc, ...)
52 1.4.8.2 martin #else
53 1.4.8.2 martin makecontext(ucp, func, argc, va_alist)
54 1.4.8.2 martin ucontext_t *ucp;
55 1.4.8.2 martin void (*func)();
56 1.4.8.2 martin int argc;
57 1.4.8.2 martin va_dcl
58 1.4.8.2 martin #endif
59 1.4.8.2 martin {
60 1.4.8.2 martin __greg_t *gr = ucp->uc_mcontext.__gregs;
61 1.4.8.2 martin unsigned int *sp;
62 1.4.8.2 martin va_list ap;
63 1.4.8.2 martin
64 1.4.8.2 martin /* LINTED __greg_t is safe */
65 1.4.8.2 martin gr[_REG_EIP] = (__greg_t)func;
66 1.4.8.2 martin
67 1.4.8.2 martin /* LINTED uintptr_t is safe */
68 1.4.8.2 martin sp = (unsigned int *)((uintptr_t)ucp->uc_stack.ss_sp +
69 1.4.8.2 martin ucp->uc_stack.ss_size);
70 1.4.8.2 martin /* Align on word boundary. */
71 1.4.8.2 martin /* LINTED uintptr_t is safe */
72 1.4.8.2 martin sp = (unsigned int *)((uintptr_t)sp & ~0x3);
73 1.4.8.2 martin sp -= argc + 1; /* Make room for ret and args. */
74 1.4.8.2 martin /* LINTED __greg_t is safe */
75 1.4.8.2 martin gr[_REG_UESP] = (__greg_t)sp;
76 1.4.8.2 martin gr[_REG_EBP] = (__greg_t)0; /* Wipe out frame pointer. */
77 1.4.8.2 martin
78 1.4.8.2 martin /* Put return address on top of stack. */
79 1.4.8.2 martin /* LINTED uintptr_t is safe */
80 1.4.8.2 martin *sp++ = (uintptr_t)_resumecontext;
81 1.4.8.2 martin
82 1.4.8.2 martin /* Construct argument list. */
83 1.4.8.2 martin #if __STDC__
84 1.4.8.2 martin va_start(ap, argc);
85 1.4.8.2 martin #else
86 1.4.8.2 martin va_start(ap);
87 1.4.8.2 martin #endif
88 1.4.8.2 martin while (argc-- > 0) {
89 1.4.8.2 martin /* LINTED uintptr_t is safe */
90 1.4.8.2 martin *sp++ = va_arg(ap, uintptr_t);
91 1.4.8.2 martin }
92 1.4.8.2 martin va_end(ap);
93 1.4.8.2 martin }
94