127 lines
3.1 KiB
ArmAsm
127 lines
3.1 KiB
ArmAsm
/* Copyright (C) 1996 Free Software Foundation, Inc.
|
|
This file is part of the GNU C Library.
|
|
Contributed by Richard Henderson <rth@tamu.edu>, 1996.
|
|
|
|
The GNU C Library is free software; you can redistribute it and/or
|
|
modify it under the terms of the GNU Library General Public License as
|
|
published by the Free Software Foundation; either version 2 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
|
|
Library General Public License for more details.
|
|
|
|
You should have received a copy of the GNU Library General Public
|
|
License along with the GNU C Library; see the file COPYING.LIB. If not,
|
|
write to the Free Software Foundation, Inc., 59 Temple Place - Suite 330,
|
|
Boston, MA 02111-1307, USA. */
|
|
|
|
/* clone() is even more special than fork() as it mucks with stacks
|
|
and invokes a function in the right context after its all over. */
|
|
|
|
#include <sysdep.h>
|
|
#define _ERRNO_H 1
|
|
#include <errnos.h>
|
|
|
|
/* int clone(int (*fn)(), void *child_stack, int flags, int nargs, ...) */
|
|
|
|
.text
|
|
ENTRY(__clone)
|
|
lda sp,-16(sp)
|
|
.frame sp,16,$26,0
|
|
/* Save rest of argument registers for varargs-type work. */
|
|
stq a4,0(sp)
|
|
stq a5,8(sp)
|
|
#ifdef PROF
|
|
.set noat
|
|
lda AT, _mcount
|
|
jsr AT, (AT), _mcount
|
|
.set at
|
|
#endif
|
|
.prologue 1
|
|
|
|
/* Sanity check arguments. */
|
|
sextl a3,a3
|
|
ldiq v0,EINVAL
|
|
beq a0,$error /* no NULL function pointers */
|
|
beq a1,$error /* no NULL stack pointers */
|
|
blt a3,$error /* no negative argument counts */
|
|
|
|
/* Allocate space on the new stack and copy args over */
|
|
mov a3,t0 /* save nargs for thread_start */
|
|
s8addq a3,sp,t1
|
|
1: ldq t2,-8(t1)
|
|
subq t1,8,t1
|
|
stq t2,-8(a1)
|
|
subq a3,1,a3
|
|
subq a1,8,a1
|
|
bne a3,1b
|
|
|
|
/* Do the system call */
|
|
mov a0,pv /* get fn ptr out of the way */
|
|
mov a2,a0
|
|
ldiq v0,__NR_clone
|
|
call_pal PAL_callsys
|
|
|
|
bne a3,$error
|
|
beq v0,thread_start
|
|
|
|
/* Successful return from the parent */
|
|
lda sp,16(sp)
|
|
ret
|
|
|
|
/* Something bad happened -- no child created */
|
|
$error:
|
|
br gp,1f
|
|
1: ldgp gp,0(gp)
|
|
lda sp,16(sp)
|
|
jmp zero,__syscall_error
|
|
|
|
END(__clone)
|
|
|
|
/* Load up the arguments to the function. Put this block of code in
|
|
its own function so that we can terminate the stack trace with our
|
|
debug info.
|
|
|
|
At this point we have $t0=nargs, $pv=fn, $sp=&arg[0]. */
|
|
|
|
.ent thread_start
|
|
thread_start:
|
|
.frame fp,0,zero,0
|
|
mov zero,fp
|
|
.prologue 0
|
|
|
|
/* Calculate address of jump into argument loading code */
|
|
cmple t0,6,t2 /* no more than 6 args in registers */
|
|
cmoveq t2,6,t0
|
|
br v0,1f /* find address of arg0 */
|
|
1: lda v0,$arg0-1b(v0)
|
|
s4addq t0,zero,t1
|
|
subq v0,t1,v0
|
|
jmp (v0)
|
|
|
|
/* Load the integer register arguments */
|
|
ldq a5,40(sp)
|
|
ldq a4,32(sp)
|
|
ldq a3,24(sp)
|
|
ldq a2,16(sp)
|
|
ldq a1,8(sp)
|
|
ldq a0,0(sp)
|
|
$arg0:
|
|
|
|
/* Adjust stack to remove the arguments we just loaded */
|
|
s8addq t0,sp,sp
|
|
|
|
/* Call the user's function */
|
|
jsr ra,(pv)
|
|
ldgp gp,0(ra)
|
|
|
|
/* Call _exit rather than doing it inline for breakpoint purposes */
|
|
mov v0,a0
|
|
jsr ra,_exit
|
|
|
|
.end thread_start
|
|
|
|
weak_alias(__clone, clone)
|