makecontext.c revision 1.7
11.7Sthorpej/* $NetBSD: makecontext.c,v 1.7 2021/07/06 12:38:40 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 * 191.2Sthorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 201.2Sthorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 211.2Sthorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 221.2Sthorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 231.2Sthorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 241.2Sthorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 251.2Sthorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 261.2Sthorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 271.2Sthorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 281.2Sthorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 291.2Sthorpej * POSSIBILITY OF SUCH DAMAGE. 301.2Sthorpej */ 311.2Sthorpej 321.2Sthorpej#include <sys/cdefs.h> 331.2Sthorpej#if defined(LIBC_SCCS) && !defined(lint) 341.7Sthorpej__RCSID("$NetBSD: makecontext.c,v 1.7 2021/07/06 12:38:40 thorpej Exp $"); 351.2Sthorpej#endif 361.2Sthorpej 371.2Sthorpej#include <stddef.h> 381.2Sthorpej#include <inttypes.h> 391.2Sthorpej#include <ucontext.h> 401.2Sthorpej#include "extern.h" 411.2Sthorpej 421.2Sthorpej#include <stdarg.h> 431.2Sthorpej 441.6Sjoergvoid __resumecontext(void) __dead; 451.6Sjoerg 461.2Sthorpejvoid 471.2Sthorpejmakecontext(ucontext_t *ucp, void (*func)(void), int argc, ...) 481.2Sthorpej{ 491.2Sthorpej __greg_t *gr = ucp->uc_mcontext.__gregs; 501.2Sthorpej int i; 511.2Sthorpej unsigned long *sp; 521.2Sthorpej va_list ap; 531.2Sthorpej 541.7Sthorpej /* Compute stack pointer. */ 551.2Sthorpej sp = (unsigned long *) 561.7Sthorpej ((uintptr_t)ucp->uc_stack.ss_sp + ucp->uc_stack.ss_size); 571.2Sthorpej /* Allocate necessary stack space for arguments exceeding a0-5. */ 581.2Sthorpej if (argc > 6) 591.2Sthorpej sp -= (argc - 6); 601.7Sthorpej /* Align stack pointer. */ 611.7Sthorpej sp = (unsigned long *)((uintptr_t)sp & ~0xfUL); 621.2Sthorpej gr[_REG_SP] = (__greg_t)sp; 631.2Sthorpej /* Arrange for return via the trampoline code. */ 641.3Sdrochner gr[_REG_RA] = (__greg_t)__resumecontext; 651.2Sthorpej gr[_REG_PC] = (__greg_t)func; 661.2Sthorpej gr[_REG_PV] = (__greg_t)func; 671.2Sthorpej 681.2Sthorpej va_start(ap, argc); 691.2Sthorpej /* Pass up to six arguments in a0-5. */ 701.2Sthorpej for (i = 0; i < argc && i < 6; i++) 711.2Sthorpej gr[_REG_A0 + i] = va_arg(ap, unsigned long); 721.2Sthorpej /* Pass any additional arguments on the stack. */ 731.2Sthorpej for (argc -= i; argc > 0; argc--) 741.2Sthorpej *sp++ = va_arg(ap, unsigned long); 751.2Sthorpej va_end(ap); 761.2Sthorpej} 77