12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273 |
- #include <stdarg.h>
- #include <ucontext.h>
- #define NREG_ARGS 4
- 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;
-
- funcstack = (unsigned long *) (ucp->uc_stack.ss_sp + ucp->uc_stack.ss_size);
-
- misaligned = ((unsigned long) funcstack & 4) != 0;
- if ((argc > NREG_ARGS) && (argc & 1) != 0)
- misaligned = !misaligned;
- if (misaligned)
- funcstack -= 1;
- va_start (vl, argc);
-
- if (argc > NREG_ARGS)
- funcstack -= (argc - NREG_ARGS);
- ucp->uc_mcontext.arm_sp = (unsigned long) funcstack;
- ucp->uc_mcontext.arm_pc = (unsigned long) func;
-
- ucp->uc_mcontext.arm_r4 = (unsigned long) ucp->uc_link;
- ucp->uc_mcontext.arm_lr = (unsigned long) __startcontext;
-
- regptr = &(ucp->uc_mcontext.arm_r0);
- for (reg = 0; (reg < argc) && (reg < NREG_ARGS); reg++)
- *regptr++ = va_arg (vl, unsigned long);
-
- for (; reg < argc; reg++)
- *funcstack++ = va_arg (vl, unsigned long);
- va_end (vl);
- }
- weak_alias (__makecontext, makecontext)
|