makecontext.c revision 1.2
11.2Sthorpej/* $NetBSD: makecontext.c,v 1.2 2003/01/18 11:04:39 thorpej Exp $ */ 21.2Sthorpej 31.2Sthorpej/*- 41.2Sthorpej * Copyright (c) 2001 The NetBSD Foundation, Inc. 51.2Sthorpej * All rights reserved. 61.2Sthorpej * 71.2Sthorpej * This code is derived from software contributed to The NetBSD Foundation 81.2Sthorpej * by Klaus Klein. 91.2Sthorpej * 101.2Sthorpej * Redistribution and use in source and binary forms, with or without 111.2Sthorpej * modification, are permitted provided that the following conditions 121.2Sthorpej * are met: 131.2Sthorpej * 1. Redistributions of source code must retain the above copyright 141.2Sthorpej * notice, this list of conditions and the following disclaimer. 151.2Sthorpej * 2. Redistributions in binary form must reproduce the above copyright 161.2Sthorpej * notice, this list of conditions and the following disclaimer in the 171.2Sthorpej * documentation and/or other materials provided with the distribution. 181.2Sthorpej * 3. All advertising materials mentioning features or use of this software 191.2Sthorpej * must display the following acknowledgement: 201.2Sthorpej * This product includes software developed by the NetBSD 211.2Sthorpej * Foundation, Inc. and its contributors. 221.2Sthorpej * 4. Neither the name of The NetBSD Foundation nor the names of its 231.2Sthorpej * contributors may be used to endorse or promote products derived 241.2Sthorpej * from this software without specific prior written permission. 251.2Sthorpej * 261.2Sthorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 271.2Sthorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 281.2Sthorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 291.2Sthorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 301.2Sthorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 311.2Sthorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 321.2Sthorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 331.2Sthorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 341.2Sthorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 351.2Sthorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 361.2Sthorpej * POSSIBILITY OF SUCH DAMAGE. 371.2Sthorpej */ 381.2Sthorpej 391.2Sthorpej#include <sys/cdefs.h> 401.2Sthorpej#if defined(LIBC_SCCS) && !defined(lint) 411.2Sthorpej__RCSID("$NetBSD: makecontext.c,v 1.2 2003/01/18 11:04:39 thorpej Exp $"); 421.2Sthorpej#endif 431.2Sthorpej 441.2Sthorpej#include <stddef.h> 451.2Sthorpej#include <inttypes.h> 461.2Sthorpej#include <ucontext.h> 471.2Sthorpej#include "extern.h" 481.2Sthorpej 491.2Sthorpej#include <stdarg.h> 501.2Sthorpej 511.2Sthorpejvoid 521.2Sthorpejmakecontext(ucontext_t *ucp, void (*func)(void), int argc, ...) 531.2Sthorpej{ 541.2Sthorpej __greg_t *gr = ucp->uc_mcontext.__gregs; 551.2Sthorpej int i; 561.2Sthorpej unsigned long *sp; 571.2Sthorpej va_list ap; 581.2Sthorpej 591.2Sthorpej /* Compute and align stack pointer. */ 601.2Sthorpej sp = (unsigned long *) 611.2Sthorpej (((uintptr_t)ucp->uc_stack.ss_sp + ucp->uc_stack.ss_size) & ~0x7); 621.2Sthorpej /* Allocate necessary stack space for arguments exceeding a0-5. */ 631.2Sthorpej if (argc > 6) 641.2Sthorpej sp -= (argc - 6); 651.2Sthorpej gr[_REG_SP] = (__greg_t)sp; 661.2Sthorpej /* Arrange for return via the trampoline code. */ 671.2Sthorpej gr[_REG_RA] = (__greg_t)_resumecontext; 681.2Sthorpej gr[_REG_PC] = (__greg_t)func; 691.2Sthorpej gr[_REG_PV] = (__greg_t)func; 701.2Sthorpej 711.2Sthorpej va_start(ap, argc); 721.2Sthorpej /* Pass up to six arguments in a0-5. */ 731.2Sthorpej for (i = 0; i < argc && i < 6; i++) 741.2Sthorpej gr[_REG_A0 + i] = va_arg(ap, unsigned long); 751.2Sthorpej /* Pass any additional arguments on the stack. */ 761.2Sthorpej for (argc -= i; argc > 0; argc--) 771.2Sthorpej *sp++ = va_arg(ap, unsigned long); 781.2Sthorpej va_end(ap); 791.2Sthorpej} 80