/* Copyright (C) 2001 Free Software Foundation, Inc.
   This file is part of the GNU C Library.
   Contributed by Martin Schwidefsky (schwidefsky@de.ibm.com).

   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, write to the Free
   Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
   02111-1307 USA.  */

#include <libintl.h>
#include <stdarg.h>
#include <stdio.h>
#include <stdlib.h>
#include <ucontext.h>

/* This implementation can handle any ARGC value but only
   normal integer type parameters. Parameters of type float,
   double, complex and structure with sizes 0, 2, 4 or 8
   won't work.
   makecontext sets up a stack and the registers for the
   user context. The stack looks like this:
           size                         offset
    %r15 ->    +-----------------------+
             8 | back chain (zero)     |  0
             8 | reserved              |  8
           144 | save area for (*func) | 16
               +-----------------------+
             n | overflow parameters   | 160
               +-----------------------+
   The registers are set up like this:
     %r2-%r6: parameters 1 to 5
     %r7    : (*func) pointer
     %r8    : uc_link from ucontext structure
     %r9    : address of setcontext
     %r14   : return address to uc_link trampoline
     %r15   : stack pointer.

   The trampoline looks like this:
     basr  %r14,%r7
     lgr   %r2,%r8
     br    %r9.  */

void
__makecontext (ucontext_t *ucp, void (*func) (void), int argc, ...)
{
  extern void __makecontext_ret (void);
  unsigned long *sp;
  va_list ap;
  int i;

  sp = (unsigned long *) (((unsigned long) ucp->uc_stack.ss_sp
			   + ucp->uc_stack.ss_size) & -8L);

  /* Set the return address to trampoline.  */
  ucp->uc_mcontext.gregs[14] = (long) __makecontext_ret;

  /* Set register parameters.  */
  va_start (ap, argc);
  for (i = 0; (i < argc) && (i < 5); i++)
    ucp->uc_mcontext.gregs[2+i] = va_arg (ap, long);

  /* The remaining arguments go to the overflow area.  */
  if (argc > 5) {
    sp -= argc - 5;
    for (i = 5; i < argc; i++)
      sp[i] = va_arg(ap, long);
  }
  va_end (ap);

  /* Make room for the save area and set the backchain.  */
  sp -= 20;
  *sp = 0;

  /* Pass (*func) to __start_context in %r7.  */
  ucp->uc_mcontext.gregs[7] = (long) func;

  /* Pass ucp->uc_link to __start_context in %r8.  */
  ucp->uc_mcontext.gregs[8] = (long) ucp->uc_link;

  /* Pass address of setcontext in %r9.  */
  ucp->uc_mcontext.gregs[9] = (long) &setcontext;

  /* Set stack pointer.  */
  ucp->uc_mcontext.gregs[15] = (long) sp;
}

asm(".text\n"
    ".type __makecontext_ret,@function\n"
    "__makecontext_ret:\n"
    "      basr  %r14,%r7\n"
    "      lgr   %r2,%r8\n"
    "      br    %r9\n"
    ".size __makecontext_ret, .-__makecontext_ret");

weak_alias (__makecontext, makecontext)