Home | History | Annotate | Line # | Download | only in aarch64
      1 /*	$NetBSD: linux32_machdep.c,v 1.3 2024/02/07 04:20:28 msaitoh Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2021 Ryo Shimizu
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
     17  * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     18  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     20  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     21  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     22  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     24  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
     25  * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  * POSSIBILITY OF SUCH DAMAGE.
     27  */
     28 
     29 #include <sys/cdefs.h>
     30 __KERNEL_RCSID(0, "$NetBSD: linux32_machdep.c,v 1.3 2024/02/07 04:20:28 msaitoh Exp $");
     31 
     32 #include <sys/param.h>
     33 #include <sys/systm.h>
     34 #include <sys/proc.h>
     35 #include <sys/exec.h>
     36 
     37 #include <compat/netbsd32/netbsd32.h>
     38 #include <compat/netbsd32/netbsd32_exec.h>
     39 
     40 #include <compat/linux/common/linux_types.h>
     41 #include <compat/linux/common/linux_signal.h>
     42 #include <compat/linux/common/linux_errno.h>
     43 #include <compat/linux/common/linux_machdep.h>
     44 
     45 #include <compat/linux32/common/linux32_types.h>
     46 #include <compat/linux32/common/linux32_signal.h>
     47 #include <compat/linux32/common/linux32_errno.h>
     48 #include <compat/linux32/common/linux32_exec.h>
     49 #include <compat/linux32/common/linux32_machdep.h>
     50 #include <compat/linux32/linux32_syscall.h>
     51 #include <compat/linux32/linux32_syscallargs.h>
     52 
     53 #include <machine/netbsd32_machdep.h>
     54 #include <arm/vfpreg.h>
     55 
     56 static void
     57 linux32_save_sigcontext(struct lwp *l, struct linux32_ucontext *luc)
     58 {
     59 	ucontext32_t uc;
     60 	__greg32_t *gr = uc.uc_mcontext.__gregs;
     61 	__vfpregset32_t *vfpregs = &uc.uc_mcontext.__vfpregs;
     62 	struct linux32_aux_sigframe *aux;
     63 	int i;
     64 
     65 	cpu_getmcontext32(l, &uc.uc_mcontext, &uc.uc_flags);
     66 
     67 	luc->luc_mcontext.arm_r0 = gr[_REG_R0];
     68 	luc->luc_mcontext.arm_r1 = gr[_REG_R1];
     69 	luc->luc_mcontext.arm_r2 = gr[_REG_R2];
     70 	luc->luc_mcontext.arm_r3 = gr[_REG_R3];
     71 	luc->luc_mcontext.arm_r4 = gr[_REG_R4];
     72 	luc->luc_mcontext.arm_r5 = gr[_REG_R5];
     73 	luc->luc_mcontext.arm_r6 = gr[_REG_R6];
     74 	luc->luc_mcontext.arm_r7 = gr[_REG_R7];
     75 	luc->luc_mcontext.arm_r8 = gr[_REG_R8];
     76 	luc->luc_mcontext.arm_r9 = gr[_REG_R9];
     77 	luc->luc_mcontext.arm_r10 = gr[_REG_R10];
     78 	luc->luc_mcontext.arm_fp = gr[_REG_R11];
     79 	luc->luc_mcontext.arm_ip = gr[_REG_R12];
     80 	luc->luc_mcontext.arm_sp = gr[_REG_R13];
     81 	luc->luc_mcontext.arm_lr = gr[_REG_R14];
     82 	luc->luc_mcontext.arm_pc = gr[_REG_R15];
     83 	luc->luc_mcontext.arm_cpsr = gr[_REG_CPSR];
     84 	luc->luc_mcontext.trap_no = 0;
     85 	luc->luc_mcontext.error_code = 0;
     86 	luc->luc_mcontext.oldmask = 0;
     87 	luc->luc_mcontext.fault_address = 0;
     88 
     89 	if (uc.uc_flags & _UC_FPU) {
     90 		aux = (struct linux32_aux_sigframe *)luc->luc_regspace;
     91 #define LINUX32_VFP_MAGIC	0x56465001
     92 		aux->vfp.magic = LINUX32_VFP_MAGIC;
     93 		aux->vfp.size = sizeof(struct linux32_vfp_sigframe);
     94 
     95 		CTASSERT(__arraycount(aux->vfp.ufp.fpregs) ==
     96 		    __arraycount(vfpregs->__vfp_fstmx));
     97 		for (i = 0; i < __arraycount(aux->vfp.ufp.fpregs); i++)
     98 			aux->vfp.ufp.fpregs[i] = vfpregs->__vfp_fstmx[i];
     99 		aux->vfp.ufp.fpscr = vfpregs->__vfp_fpscr;
    100 
    101 		aux->vfp.ufp_exc.fpexc = VFP_FPEXC_EN | VFP_FPEXC_VECITR;
    102 		aux->vfp.ufp_exc.fpinst = 0;
    103 		aux->vfp.ufp_exc.fpinst2 = 0;
    104 		aux->end_magic = 0 ;
    105 	}
    106 }
    107 
    108 static int
    109 linux32_restore_sigcontext(struct lwp *l, struct linux32_ucontext *luc)
    110 {
    111 	struct proc * const p = l->l_proc;
    112 	ucontext32_t uc;
    113 	__greg32_t *gr = uc.uc_mcontext.__gregs;
    114 	__vfpregset32_t *vfpregs = &uc.uc_mcontext.__vfpregs;
    115 	struct linux32_aux_sigframe *aux;
    116 	int i, error;
    117 
    118 	memset(&uc, 0, sizeof(uc));
    119 
    120 	/* build .uc_sigmask */
    121 	linux32_to_native_sigset(&uc.uc_sigmask, &luc->luc_sigmask);
    122 	uc.uc_flags |= _UC_SIGMASK;
    123 
    124 	/* build .uc_stack */
    125 	if (luc->luc_stack.ss_flags & LINUX_SS_ONSTACK)
    126 		uc.uc_stack.ss_flags |= SS_ONSTACK;
    127 	if (luc->luc_stack.ss_flags & LINUX_SS_DISABLE)
    128 		uc.uc_stack.ss_flags |= SS_DISABLE;
    129 	uc.uc_flags |= _UC_STACK;
    130 
    131 	/* build .uc_mcontext */
    132 	gr[_REG_R0] = luc->luc_mcontext.arm_r0;
    133 	gr[_REG_R1] = luc->luc_mcontext.arm_r1;
    134 	gr[_REG_R2] = luc->luc_mcontext.arm_r2;
    135 	gr[_REG_R3] = luc->luc_mcontext.arm_r3;
    136 	gr[_REG_R4] = luc->luc_mcontext.arm_r4;
    137 	gr[_REG_R5] = luc->luc_mcontext.arm_r5;
    138 	gr[_REG_R6] = luc->luc_mcontext.arm_r6;
    139 	gr[_REG_R7] = luc->luc_mcontext.arm_r7;
    140 	gr[_REG_R8] = luc->luc_mcontext.arm_r8;
    141 	gr[_REG_R9] = luc->luc_mcontext.arm_r9;
    142 	gr[_REG_R10] = luc->luc_mcontext.arm_r10;
    143 	gr[_REG_R11] = luc->luc_mcontext.arm_fp;
    144 	gr[_REG_R12] = luc->luc_mcontext.arm_ip;
    145 	gr[_REG_R13] = luc->luc_mcontext.arm_sp;
    146 	gr[_REG_R14] = luc->luc_mcontext.arm_lr;
    147 	gr[_REG_R15] = luc->luc_mcontext.arm_pc;
    148 	gr[_REG_CPSR] = luc->luc_mcontext.arm_cpsr;
    149 	uc.uc_flags |= _UC_CPU;
    150 
    151 	aux = (struct linux32_aux_sigframe *)luc->luc_regspace;
    152 	if (aux->vfp.magic == LINUX32_VFP_MAGIC &&
    153 	    aux->vfp.size == sizeof(struct linux32_vfp_sigframe)) {
    154 
    155 		CTASSERT(__arraycount(vfpregs->__vfp_fstmx) ==
    156 		    __arraycount(aux->vfp.ufp.fpregs));
    157 		for (i = 0; i < __arraycount(vfpregs->__vfp_fstmx); i++)
    158 			vfpregs->__vfp_fstmx[i] = aux->vfp.ufp.fpregs[i];
    159 		vfpregs->__vfp_fpscr = aux->vfp.ufp.fpscr;
    160 
    161 		uc.uc_flags |= _UC_FPU;
    162 	}
    163 
    164 	mutex_enter(p->p_lock);
    165 	error = setucontext32(l, &uc);
    166 	mutex_exit(p->p_lock);
    167 
    168 	return error;
    169 }
    170 
    171 void
    172 linux32_sendsig(const ksiginfo_t *ksi, const sigset_t *mask)
    173 {
    174 	struct lwp * const l = curlwp;
    175 	struct proc * const p = l->l_proc;
    176 	struct trapframe * const tf = lwp_trapframe(l);
    177 	stack_t * const ss = &l->l_sigstk;
    178 	const int sig = ksi->ksi_signo;
    179 	const sig_t handler = SIGACTION(p, sig).sa_handler;
    180 	struct linux32_rt_sigframe rt_sigframe_buf, *u_rt_sigframe;
    181 	struct linux32_sigframe *tmp_sigframe, *u_sigframe;
    182 	struct linux32_siginfo *tmp_siginfo, *u_siginfo;
    183 	vaddr_t sp;
    184 	int error;
    185 	const bool onstack_p = /* use signal stack? */
    186 	    (ss->ss_flags & (SS_DISABLE | SS_ONSTACK)) == 0 &&
    187 	    (SIGACTION(p, sig).sa_flags & SA_ONSTACK) != 0;
    188 	const bool rt_p = !!(SIGACTION(curproc, ksi->ksi_signo).sa_flags &
    189 	    SA_SIGINFO);
    190 
    191 	sp = onstack_p ? ((vaddr_t)ss->ss_sp + ss->ss_size) & -16 :
    192 	    tf->tf_reg[13];
    193 
    194 	memset(&rt_sigframe_buf, 0, sizeof(rt_sigframe_buf));
    195 
    196 	if (rt_p) {
    197 		/* allocate rt_sigframe on stack */
    198 		sp -= sizeof(struct linux32_rt_sigframe);
    199 		u_rt_sigframe = (struct linux32_rt_sigframe *)sp;
    200 		u_sigframe = &u_rt_sigframe->sig;
    201 		u_siginfo = &u_rt_sigframe->info;
    202 		tmp_sigframe = &rt_sigframe_buf.sig;
    203 		tmp_siginfo = &rt_sigframe_buf.info;
    204 	} else {
    205 		/* allocate sigframe on stack */
    206 		sp -= sizeof(struct linux32_sigframe);
    207 		u_rt_sigframe = NULL;
    208 		u_sigframe = (struct linux32_sigframe *)sp;
    209 		u_siginfo = NULL;
    210 		tmp_sigframe = &rt_sigframe_buf.sig;
    211 		tmp_siginfo = NULL;
    212 	}
    213 
    214 	if ((vaddr_t)sp >= VM_MAXUSER_ADDRESS32) {
    215 		sigexit(l, SIGILL);
    216 		return;
    217 	}
    218 
    219 	/* build linux sigframe, and copyout to user stack */
    220 	tmp_sigframe->uc.luc_flags = 0;
    221 	tmp_sigframe->uc.luc_link = NULL;
    222 	NETBSD32PTR32(tmp_sigframe->uc.luc_stack.ss_sp, ss->ss_sp);
    223 	tmp_sigframe->uc.luc_stack.ss_size = ss->ss_size;
    224 	tmp_sigframe->uc.luc_stack.ss_flags = 0;
    225 	if (ss->ss_flags & SS_ONSTACK)
    226 		tmp_sigframe->uc.luc_stack.ss_flags |= LINUX_SS_ONSTACK;
    227 	if (ss->ss_flags & SS_DISABLE)
    228 		tmp_sigframe->uc.luc_stack.ss_flags |= LINUX_SS_DISABLE;
    229 	native_to_linux32_sigset(&tmp_sigframe->uc.luc_sigmask, mask);
    230 	if (tmp_siginfo != NULL)
    231 		native_to_linux32_siginfo(tmp_siginfo, &ksi->ksi_info);
    232 	sendsig_reset(l, sig);
    233 
    234 	mutex_exit(p->p_lock);
    235 	linux32_save_sigcontext(l, &tmp_sigframe->uc);
    236 
    237 	/* copy linux sigframe onto the user stack */
    238 	if (rt_p) {
    239 		error = copyout(&rt_sigframe_buf, u_rt_sigframe,
    240 		    sizeof(rt_sigframe_buf));
    241 	} else {
    242 		error = copyout(tmp_sigframe, u_sigframe,
    243 		    sizeof(*tmp_sigframe));
    244 	}
    245 
    246 	mutex_enter(p->p_lock);
    247 
    248 	if (error != 0 || (vaddr_t)handler >= VM_MAXUSER_ADDRESS32) {
    249 		sigexit(l, SIGILL);
    250 		return;
    251 	}
    252 
    253 	/* build context to run handler in. */
    254 	tf->tf_reg[0] = native_to_linux_signo[sig];
    255 	tf->tf_reg[1] = NETBSD32PTR32I(u_siginfo);
    256 	tf->tf_reg[2] = NETBSD32PTR32I(&u_sigframe->uc);
    257 	tf->tf_pc = (uint64_t)handler;
    258 	tf->tf_reg[13] = sp;
    259 
    260 	/* sigreturn trampoline */
    261 	extern char linux32_sigcode[], linux32_rt_sigcode[];
    262 	vsize_t linux_sigcode_offset;
    263 	if (rt_p) {
    264 		/* set return address to linux32_rt_sigcode() */
    265 		linux_sigcode_offset = linux32_rt_sigcode - linux32_sigcode;
    266 	} else {
    267 		/* set return address to linux32_sigcode() */
    268 		linux_sigcode_offset = linux32_sigcode - linux32_sigcode;
    269 	}
    270 	/* tf->tf_reg[14] is aarch32 lr */
    271 	tf->tf_reg[14] = NETBSD32PTR32I((char *)p->p_sigctx.ps_sigcode +
    272 	    linux_sigcode_offset);
    273 
    274 	if (onstack_p)
    275 		ss->ss_flags |= SS_ONSTACK;
    276 }
    277 
    278 int
    279 linux32_sys_sigreturn(struct lwp *l,
    280     const struct linux32_sys_sigreturn_args *uap, register_t *retval)
    281 {
    282 	struct trapframe * const tf = lwp_trapframe(l);
    283 	struct linux32_sigframe sigframe;
    284 	int error;
    285 
    286 	error = copyin((void *)tf->tf_reg[13], &sigframe, sizeof(sigframe));
    287 	if (error != 0)
    288 		goto done;
    289 
    290 	error = linux32_restore_sigcontext(l, &sigframe.uc);
    291 	if (error != 0)
    292 		goto done;
    293 	error = EJUSTRETURN;
    294 
    295  done:
    296 	return error;
    297 }
    298 
    299 int
    300 linux32_sys_rt_sigreturn(struct lwp *l,
    301     const struct linux32_sys_rt_sigreturn_args *uap, register_t *retval)
    302 {
    303 	struct trapframe * const tf = lwp_trapframe(l);
    304 	struct linux32_rt_sigframe rt_sigframe;
    305 	int error;
    306 
    307 	error = copyin((void *)tf->tf_reg[13], &rt_sigframe,
    308 	    sizeof(rt_sigframe));
    309 	if (error != 0)
    310 		goto done;
    311 
    312 	error = linux32_restore_sigcontext(l, &rt_sigframe.sig.uc);
    313 	if (error != 0)
    314 		goto done;
    315 	error = EJUSTRETURN;
    316 
    317  done:
    318 	return error;
    319 }
    320 
    321 void
    322 linux32_setregs(struct lwp *l, struct exec_package *pack, u_long stack)
    323 {
    324 	struct trapframe * const tf = lwp_trapframe(l);
    325 
    326 	netbsd32_setregs(l, pack, stack);
    327 
    328 	/* Same as netbsd32_setregs(), but some registers are set for linux */
    329 	tf->tf_reg[0] = 0;
    330 	tf->tf_reg[12] = 0;
    331 	tf->tf_reg[13] = stack;		/* sp */
    332 	tf->tf_reg[14] = pack->ep_entry;/* lr */
    333 	tf->tf_reg[18] = 0;
    334 	tf->tf_pc = pack->ep_entry;
    335 }
    336 
    337 int
    338 linux32_sys_set_tls(struct lwp *l, const struct linux32_sys_set_tls_args *uap,
    339     register_t *retval)
    340 {
    341 	/* {
    342 		syscallarg(netbsd32_voidp) tls;
    343 	} */
    344 	return lwp_setprivate(l, SCARG_P32(uap, tls));
    345 }
    346 
    347 int
    348 linux32_sys_get_tls(struct lwp *l, const void *uap, register_t *retval)
    349 {
    350 	retval[0] = NETBSD32PTR32I(l->l_private);
    351 	return 0;
    352 }
    353