2014-01-01 19:03:15 +08:00
|
|
|
/* Copyright (C) 2012-2014 Free Software Foundation, Inc.
|
2012-03-06 06:58:13 +08:00
|
|
|
This file is part of the GNU C Library.
|
|
|
|
|
|
|
|
The GNU C Library is free software; you can redistribute it and/or
|
|
|
|
modify it under the terms of the GNU Lesser General Public
|
|
|
|
License as published by the Free Software Foundation; either
|
|
|
|
version 2.1 of the License, or (at your option) any later version.
|
|
|
|
|
|
|
|
The GNU C Library is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
|
Lesser General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU Lesser General Public
|
|
|
|
License along with the GNU C Library; if not, see
|
|
|
|
<http://www.gnu.org/licenses/>. */
|
|
|
|
|
|
|
|
#include <stdarg.h>
|
|
|
|
#include <ucontext.h>
|
|
|
|
|
|
|
|
/* Number of arguments that go in registers. */
|
|
|
|
#define NREG_ARGS 4
|
|
|
|
|
|
|
|
/* Take a context previously prepared via getcontext() and set to
|
|
|
|
call func() with the given int only args. */
|
|
|
|
void
|
|
|
|
__makecontext (ucontext_t *ucp, void (*func) (void), int argc, ...)
|
|
|
|
{
|
|
|
|
extern void __startcontext (void);
|
|
|
|
unsigned long *funcstack;
|
|
|
|
va_list vl;
|
|
|
|
unsigned long *regptr;
|
|
|
|
unsigned int reg;
|
|
|
|
int misaligned;
|
|
|
|
|
|
|
|
/* Start at the top of stack. */
|
|
|
|
funcstack = (unsigned long *) (ucp->uc_stack.ss_sp + ucp->uc_stack.ss_size);
|
|
|
|
|
|
|
|
/* Ensure the stack stays eight byte aligned. */
|
|
|
|
misaligned = ((unsigned long) funcstack & 4) != 0;
|
|
|
|
|
|
|
|
if ((argc > NREG_ARGS) && (argc & 1) != 0)
|
|
|
|
misaligned = !misaligned;
|
|
|
|
|
|
|
|
if (misaligned)
|
|
|
|
funcstack -= 1;
|
|
|
|
|
|
|
|
va_start (vl, argc);
|
|
|
|
|
|
|
|
/* Reserve space for the on-stack arguments. */
|
|
|
|
if (argc > NREG_ARGS)
|
|
|
|
funcstack -= (argc - NREG_ARGS);
|
|
|
|
|
|
|
|
ucp->uc_mcontext.arm_sp = (unsigned long) funcstack;
|
|
|
|
ucp->uc_mcontext.arm_pc = (unsigned long) func;
|
|
|
|
|
|
|
|
/* Exit to startcontext() with the next context in R4 */
|
|
|
|
ucp->uc_mcontext.arm_r4 = (unsigned long) ucp->uc_link;
|
|
|
|
ucp->uc_mcontext.arm_lr = (unsigned long) __startcontext;
|
|
|
|
|
|
|
|
/* The first four arguments go into registers. */
|
|
|
|
regptr = &(ucp->uc_mcontext.arm_r0);
|
|
|
|
|
|
|
|
for (reg = 0; (reg < argc) && (reg < NREG_ARGS); reg++)
|
|
|
|
*regptr++ = va_arg (vl, unsigned long);
|
|
|
|
|
|
|
|
/* And the remainder on the stack. */
|
|
|
|
for (; reg < argc; reg++)
|
|
|
|
*funcstack++ = va_arg (vl, unsigned long);
|
|
|
|
|
|
|
|
va_end (vl);
|
|
|
|
}
|
|
|
|
weak_alias (__makecontext, makecontext)
|