makecontext.c revision 1.3
11.3Sdrochner/* $NetBSD: makecontext.c,v 1.3 2004/03/01 19:26:29 drochner 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.3Sdrochner__RCSID("$NetBSD: makecontext.c,v 1.3 2004/03/01 19:26:29 drochner 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.3Sdrochner void __resumecontext(void); 601.3Sdrochner 611.2Sthorpej /* Compute and align stack pointer. */ 621.2Sthorpej sp = (unsigned long *) 631.2Sthorpej (((uintptr_t)ucp->uc_stack.ss_sp + ucp->uc_stack.ss_size) & ~0x7); 641.2Sthorpej /* Allocate necessary stack space for arguments exceeding a0-5. */ 651.2Sthorpej if (argc > 6) 661.2Sthorpej sp -= (argc - 6); 671.2Sthorpej gr[_REG_SP] = (__greg_t)sp; 681.2Sthorpej /* Arrange for return via the trampoline code. */ 691.3Sdrochner gr[_REG_RA] = (__greg_t)__resumecontext; 701.2Sthorpej gr[_REG_PC] = (__greg_t)func; 711.2Sthorpej gr[_REG_PV] = (__greg_t)func; 721.2Sthorpej 731.2Sthorpej va_start(ap, argc); 741.2Sthorpej /* Pass up to six arguments in a0-5. */ 751.2Sthorpej for (i = 0; i < argc && i < 6; i++) 761.2Sthorpej gr[_REG_A0 + i] = va_arg(ap, unsigned long); 771.2Sthorpej /* Pass any additional arguments on the stack. */ 781.2Sthorpej for (argc -= i; argc > 0; argc--) 791.2Sthorpej *sp++ = va_arg(ap, unsigned long); 801.2Sthorpej va_end(ap); 811.2Sthorpej} 82