1*22ce4affSfengbojiang /*-
2*22ce4affSfengbojiang  * Copyright (c) 2015-2016 Nuxi, https://nuxi.nl/
3*22ce4affSfengbojiang  *
4*22ce4affSfengbojiang  * Redistribution and use in source and binary forms, with or without
5*22ce4affSfengbojiang  * modification, are permitted provided that the following conditions
6*22ce4affSfengbojiang  * are met:
7*22ce4affSfengbojiang  * 1. Redistributions of source code must retain the above copyright
8*22ce4affSfengbojiang  *    notice, this list of conditions and the following disclaimer.
9*22ce4affSfengbojiang  * 2. Redistributions in binary form must reproduce the above copyright
10*22ce4affSfengbojiang  *    notice, this list of conditions and the following disclaimer in the
11*22ce4affSfengbojiang  *    documentation and/or other materials provided with the distribution.
12*22ce4affSfengbojiang  *
13*22ce4affSfengbojiang  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
14*22ce4affSfengbojiang  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
15*22ce4affSfengbojiang  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
16*22ce4affSfengbojiang  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
17*22ce4affSfengbojiang  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
18*22ce4affSfengbojiang  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
19*22ce4affSfengbojiang  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
20*22ce4affSfengbojiang  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
21*22ce4affSfengbojiang  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
22*22ce4affSfengbojiang  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
23*22ce4affSfengbojiang  * SUCH DAMAGE.
24*22ce4affSfengbojiang  */
25*22ce4affSfengbojiang 
26*22ce4affSfengbojiang #include <sys/cdefs.h>
27*22ce4affSfengbojiang __FBSDID("$FreeBSD$");
28*22ce4affSfengbojiang 
29*22ce4affSfengbojiang #include <sys/param.h>
30*22ce4affSfengbojiang #include <sys/imgact.h>
31*22ce4affSfengbojiang #include <sys/kernel.h>
32*22ce4affSfengbojiang #include <sys/proc.h>
33*22ce4affSfengbojiang #include <sys/sysent.h>
34*22ce4affSfengbojiang 
35*22ce4affSfengbojiang #include <vm/vm.h>
36*22ce4affSfengbojiang #include <vm/pmap.h>
37*22ce4affSfengbojiang 
38*22ce4affSfengbojiang #include <machine/frame.h>
39*22ce4affSfengbojiang #include <machine/pcb.h>
40*22ce4affSfengbojiang #include <machine/vmparam.h>
41*22ce4affSfengbojiang 
42*22ce4affSfengbojiang #include <compat/cloudabi/cloudabi_util.h>
43*22ce4affSfengbojiang 
44*22ce4affSfengbojiang #include <compat/cloudabi32/cloudabi32_syscall.h>
45*22ce4affSfengbojiang #include <compat/cloudabi32/cloudabi32_util.h>
46*22ce4affSfengbojiang 
47*22ce4affSfengbojiang extern const char *cloudabi32_syscallnames[];
48*22ce4affSfengbojiang extern struct sysent cloudabi32_sysent[];
49*22ce4affSfengbojiang 
50*22ce4affSfengbojiang static void
cloudabi32_proc_setregs(struct thread * td,struct image_params * imgp,uintptr_t stack)51*22ce4affSfengbojiang cloudabi32_proc_setregs(struct thread *td, struct image_params *imgp,
52*22ce4affSfengbojiang     uintptr_t stack)
53*22ce4affSfengbojiang {
54*22ce4affSfengbojiang 	struct trapframe *regs;
55*22ce4affSfengbojiang 
56*22ce4affSfengbojiang 	exec_setregs(td, imgp, stack);
57*22ce4affSfengbojiang 
58*22ce4affSfengbojiang 	/*
59*22ce4affSfengbojiang 	 * The stack now contains a pointer to the TCB and the auxiliary
60*22ce4affSfengbojiang 	 * vector. Let r0 point to the auxiliary vector, and set
61*22ce4affSfengbojiang 	 * tpidrurw to the TCB.
62*22ce4affSfengbojiang 	 */
63*22ce4affSfengbojiang 	regs = td->td_frame;
64*22ce4affSfengbojiang 	regs->tf_r0 =
65*22ce4affSfengbojiang 	    stack + roundup(sizeof(cloudabi32_tcb_t), sizeof(register_t));
66*22ce4affSfengbojiang 	(void)cpu_set_user_tls(td, TO_PTR(stack));
67*22ce4affSfengbojiang }
68*22ce4affSfengbojiang 
69*22ce4affSfengbojiang static int
cloudabi32_fetch_syscall_args(struct thread * td)70*22ce4affSfengbojiang cloudabi32_fetch_syscall_args(struct thread *td)
71*22ce4affSfengbojiang {
72*22ce4affSfengbojiang 	struct trapframe *frame;
73*22ce4affSfengbojiang 	struct syscall_args *sa;
74*22ce4affSfengbojiang 	int error;
75*22ce4affSfengbojiang 
76*22ce4affSfengbojiang 	frame = td->td_frame;
77*22ce4affSfengbojiang 	sa = &td->td_sa;
78*22ce4affSfengbojiang 
79*22ce4affSfengbojiang 	/* Obtain system call number. */
80*22ce4affSfengbojiang 	sa->code = frame->tf_r12;
81*22ce4affSfengbojiang 	if (sa->code >= CLOUDABI32_SYS_MAXSYSCALL)
82*22ce4affSfengbojiang 		return (ENOSYS);
83*22ce4affSfengbojiang 	sa->callp = &cloudabi32_sysent[sa->code];
84*22ce4affSfengbojiang 
85*22ce4affSfengbojiang 	/* Fetch system call arguments from registers and the stack. */
86*22ce4affSfengbojiang 	sa->args[0] = frame->tf_r0;
87*22ce4affSfengbojiang 	sa->args[1] = frame->tf_r1;
88*22ce4affSfengbojiang 	sa->args[2] = frame->tf_r2;
89*22ce4affSfengbojiang 	sa->args[3] = frame->tf_r3;
90*22ce4affSfengbojiang 	if (sa->callp->sy_narg > 4) {
91*22ce4affSfengbojiang 		error = copyin((void *)td->td_frame->tf_usr_sp, &sa->args[4],
92*22ce4affSfengbojiang 		    (sa->callp->sy_narg - 4) * sizeof(register_t));
93*22ce4affSfengbojiang 		if (error != 0)
94*22ce4affSfengbojiang 			return (error);
95*22ce4affSfengbojiang 	}
96*22ce4affSfengbojiang 
97*22ce4affSfengbojiang 	/* Default system call return values. */
98*22ce4affSfengbojiang 	td->td_retval[0] = 0;
99*22ce4affSfengbojiang 	td->td_retval[1] = frame->tf_r1;
100*22ce4affSfengbojiang 	return (0);
101*22ce4affSfengbojiang }
102*22ce4affSfengbojiang 
103*22ce4affSfengbojiang static void
cloudabi32_set_syscall_retval(struct thread * td,int error)104*22ce4affSfengbojiang cloudabi32_set_syscall_retval(struct thread *td, int error)
105*22ce4affSfengbojiang {
106*22ce4affSfengbojiang 	struct trapframe *frame = td->td_frame;
107*22ce4affSfengbojiang 
108*22ce4affSfengbojiang 	switch (error) {
109*22ce4affSfengbojiang 	case 0:
110*22ce4affSfengbojiang 		/* System call succeeded. */
111*22ce4affSfengbojiang 		frame->tf_r0 = td->td_retval[0];
112*22ce4affSfengbojiang 		frame->tf_r1 = td->td_retval[1];
113*22ce4affSfengbojiang 		frame->tf_spsr &= ~PSR_C;
114*22ce4affSfengbojiang 		break;
115*22ce4affSfengbojiang 	case ERESTART:
116*22ce4affSfengbojiang 		/* Restart system call. */
117*22ce4affSfengbojiang 		frame->tf_pc -= 4;
118*22ce4affSfengbojiang 		break;
119*22ce4affSfengbojiang 	case EJUSTRETURN:
120*22ce4affSfengbojiang 		break;
121*22ce4affSfengbojiang 	default:
122*22ce4affSfengbojiang 		/* System call returned an error. */
123*22ce4affSfengbojiang 		frame->tf_r0 = cloudabi_convert_errno(error);
124*22ce4affSfengbojiang 		frame->tf_spsr |= PSR_C;
125*22ce4affSfengbojiang 		break;
126*22ce4affSfengbojiang 	}
127*22ce4affSfengbojiang }
128*22ce4affSfengbojiang 
129*22ce4affSfengbojiang static void
cloudabi32_schedtail(struct thread * td)130*22ce4affSfengbojiang cloudabi32_schedtail(struct thread *td)
131*22ce4affSfengbojiang {
132*22ce4affSfengbojiang 	struct trapframe *frame = td->td_frame;
133*22ce4affSfengbojiang 
134*22ce4affSfengbojiang 	/*
135*22ce4affSfengbojiang 	 * Initial register values for processes returning from fork.
136*22ce4affSfengbojiang 	 * Make sure that we only set these values when forking, not
137*22ce4affSfengbojiang 	 * when creating a new thread.
138*22ce4affSfengbojiang 	 */
139*22ce4affSfengbojiang 	if ((td->td_pflags & TDP_FORKING) != 0) {
140*22ce4affSfengbojiang 		frame->tf_r0 = CLOUDABI_PROCESS_CHILD;
141*22ce4affSfengbojiang 		frame->tf_r1 = td->td_tid;
142*22ce4affSfengbojiang 	}
143*22ce4affSfengbojiang }
144*22ce4affSfengbojiang 
145*22ce4affSfengbojiang int
cloudabi32_thread_setregs(struct thread * td,const cloudabi32_threadattr_t * attr,uint32_t tcb)146*22ce4affSfengbojiang cloudabi32_thread_setregs(struct thread *td,
147*22ce4affSfengbojiang     const cloudabi32_threadattr_t *attr, uint32_t tcb)
148*22ce4affSfengbojiang {
149*22ce4affSfengbojiang 	struct trapframe *frame;
150*22ce4affSfengbojiang 	stack_t stack;
151*22ce4affSfengbojiang 
152*22ce4affSfengbojiang 	/* Perform standard register initialization. */
153*22ce4affSfengbojiang 	stack.ss_sp = TO_PTR(attr->stack);
154*22ce4affSfengbojiang 	stack.ss_size = attr->stack_len;
155*22ce4affSfengbojiang 	cpu_set_upcall(td, TO_PTR(attr->entry_point), NULL, &stack);
156*22ce4affSfengbojiang 
157*22ce4affSfengbojiang 	/*
158*22ce4affSfengbojiang 	 * Pass in the thread ID of the new thread and the argument
159*22ce4affSfengbojiang 	 * pointer provided by the parent thread in as arguments to the
160*22ce4affSfengbojiang 	 * entry point.
161*22ce4affSfengbojiang 	 */
162*22ce4affSfengbojiang 	frame = td->td_frame;
163*22ce4affSfengbojiang 	frame->tf_r0 = td->td_tid;
164*22ce4affSfengbojiang 	frame->tf_r1 = attr->argument;
165*22ce4affSfengbojiang 
166*22ce4affSfengbojiang 	/* Set up TLS. */
167*22ce4affSfengbojiang 	return (cpu_set_user_tls(td, TO_PTR(tcb)));
168*22ce4affSfengbojiang }
169*22ce4affSfengbojiang 
170*22ce4affSfengbojiang static struct sysentvec cloudabi32_elf_sysvec = {
171*22ce4affSfengbojiang 	.sv_size		= CLOUDABI32_SYS_MAXSYSCALL,
172*22ce4affSfengbojiang 	.sv_table		= cloudabi32_sysent,
173*22ce4affSfengbojiang 	.sv_fixup		= cloudabi32_fixup,
174*22ce4affSfengbojiang 	.sv_name		= "CloudABI ELF32",
175*22ce4affSfengbojiang 	.sv_coredump		= elf32_coredump,
176*22ce4affSfengbojiang 	.sv_minuser		= VM_MIN_ADDRESS,
177*22ce4affSfengbojiang 	.sv_maxuser		= VM_MAXUSER_ADDRESS,
178*22ce4affSfengbojiang 	.sv_stackprot		= VM_PROT_READ | VM_PROT_WRITE,
179*22ce4affSfengbojiang 	.sv_copyout_strings	= cloudabi32_copyout_strings,
180*22ce4affSfengbojiang 	.sv_setregs		= cloudabi32_proc_setregs,
181*22ce4affSfengbojiang 	.sv_flags		= SV_ABI_CLOUDABI | SV_CAPSICUM | SV_ILP32,
182*22ce4affSfengbojiang 	.sv_set_syscall_retval	= cloudabi32_set_syscall_retval,
183*22ce4affSfengbojiang 	.sv_fetch_syscall_args	= cloudabi32_fetch_syscall_args,
184*22ce4affSfengbojiang 	.sv_syscallnames	= cloudabi32_syscallnames,
185*22ce4affSfengbojiang 	.sv_schedtail		= cloudabi32_schedtail,
186*22ce4affSfengbojiang };
187*22ce4affSfengbojiang 
188*22ce4affSfengbojiang INIT_SYSENTVEC(elf_sysvec, &cloudabi32_elf_sysvec);
189*22ce4affSfengbojiang 
190*22ce4affSfengbojiang Elf32_Brandinfo cloudabi32_brand = {
191*22ce4affSfengbojiang 	.brand		= ELFOSABI_CLOUDABI,
192*22ce4affSfengbojiang 	.machine	= EM_ARM,
193*22ce4affSfengbojiang 	.sysvec		= &cloudabi32_elf_sysvec,
194*22ce4affSfengbojiang 	.flags		= BI_BRAND_ONLY_STATIC,
195*22ce4affSfengbojiang };
196