makecontext.c revision 1.1
11.1Smatt/* $NetBSD: makecontext.c,v 1.1 2003/01/19 19:07:30 matt Exp $ */ 21.1Smatt 31.1Smatt/*- 41.1Smatt * Copyright (c) 2003 The NetBSD Foundation, Inc. 51.1Smatt * All rights reserved. 61.1Smatt * 71.1Smatt * This code is derived from software contributed to The NetBSD Foundation 81.1Smatt * by Matt Thomas. 91.1Smatt * 101.1Smatt * Redistribution and use in source and binary forms, with or without 111.1Smatt * modification, are permitted provided that the following conditions 121.1Smatt * are met: 131.1Smatt * 1. Redistributions of source code must retain the above copyright 141.1Smatt * notice, this list of conditions and the following disclaimer. 151.1Smatt * 2. Redistributions in binary form must reproduce the above copyright 161.1Smatt * notice, this list of conditions and the following disclaimer in the 171.1Smatt * documentation and/or other materials provided with the distribution. 181.1Smatt * 3. All advertising materials mentioning features or use of this software 191.1Smatt * must display the following acknowledgement: 201.1Smatt * This product includes software developed by the NetBSD 211.1Smatt * Foundation, Inc. and its contributors. 221.1Smatt * 4. Neither the name of The NetBSD Foundation nor the names of its 231.1Smatt * contributors may be used to endorse or promote products derived 241.1Smatt * from this software without specific prior written permission. 251.1Smatt * 261.1Smatt * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 271.1Smatt * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 281.1Smatt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 291.1Smatt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 301.1Smatt * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 311.1Smatt * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 321.1Smatt * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 331.1Smatt * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 341.1Smatt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 351.1Smatt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 361.1Smatt * POSSIBILITY OF SUCH DAMAGE. 371.1Smatt */ 381.1Smatt 391.1Smatt#include <sys/cdefs.h> 401.1Smatt#if defined(LIBC_SCCS) && !defined(lint) 411.1Smatt__RCSID("$NetBSD: makecontext.c,v 1.1 2003/01/19 19:07:30 matt Exp $"); 421.1Smatt#endif 431.1Smatt 441.1Smatt#include <stddef.h> 451.1Smatt#include <inttypes.h> 461.1Smatt#include <ucontext.h> 471.1Smatt#include "extern.h" 481.1Smatt 491.1Smatt#include <stdarg.h> 501.1Smatt 511.1Smattvoid 521.1Smattmakecontext(ucontext_t *ucp, void (*func)(void), int argc, ...) 531.1Smatt{ 541.1Smatt __greg_t *gr = ucp->uc_mcontext.__gregs; 551.1Smatt va_list ap; 561.1Smatt int *sp; 571.1Smatt int i; 581.1Smatt 591.1Smatt /* Compute and align stack pointer. */ 601.1Smatt sp = (int *) 611.1Smatt (((uintptr_t)ucp->uc_stack.ss_sp + ucp->uc_stack.ss_size) & ~0x3); 621.1Smatt 631.1Smatt /* 641.1Smatt * Allocate necessary stack space for arguments including arg count 651.1Smatt * and call frame 661.1Smatt */ 671.1Smatt sp -= argc + 1 + 5; 681.1Smatt 691.1Smatt va_start(ap, argc); 701.1Smatt sp[5] = argc; 711.1Smatt for (i = 0; argc > 0; argc--, i++) 721.1Smatt sp[5 + i] = va_arg(ap, int); 731.1Smatt va_end(ap); 741.1Smatt 751.1Smatt sp[0] = 0; /* condition handler is null */ 761.1Smatt sp[1] = 0x20000000; /* make this a CALLS frame */ 771.1Smatt sp[2] = 0; /* saved argument pointer */ 781.1Smatt sp[3] = 0; /* saved frame pointer */ 791.1Smatt sp[4] = (int)_resumecontext; /* return via trampoline code */ 801.1Smatt 811.1Smatt gr[_REG_AP] = (__greg_t)(sp + 5); 821.1Smatt gr[_REG_SP] = (__greg_t)sp; 831.1Smatt gr[_REG_FP] = (__greg_t)sp; 841.1Smatt gr[_REG_PC] = (__greg_t)func+2; 851.1Smatt 861.1Smatt} 87