Home | History | Annotate | Line # | Download | only in amd64
linux_machdep.c revision 1.15.2.1.2.1
      1  1.15.2.1.2.1  wrstuden /*	$NetBSD: linux_machdep.c,v 1.15.2.1.2.1 2007/06/04 01:54:19 wrstuden Exp $ */
      2           1.1      manu 
      3           1.1      manu /*-
      4           1.1      manu  * Copyright (c) 2005 Emmanuel Dreyfus, all rights reserved.
      5           1.1      manu  *
      6           1.1      manu  * Redistribution and use in source and binary forms, with or without
      7           1.1      manu  * modification, are permitted provided that the following conditions
      8           1.1      manu  * are met:
      9           1.1      manu  * 1. Redistributions of source code must retain the above copyright
     10           1.1      manu  *    notice, this list of conditions and the following disclaimer.
     11           1.1      manu  * 2. Redistributions in binary form must reproduce the above copyright
     12           1.1      manu  *    notice, this list of conditions and the following disclaimer in the
     13           1.1      manu  *    documentation and/or other materials provided with the distribution.
     14           1.1      manu  * 3. All advertising materials mentioning features or use of this software
     15           1.1      manu  *    must display the following acknowledgement:
     16           1.1      manu  *	This product includes software developed by Emmanuel Dreyfus
     17           1.1      manu  * 4. The name of the author may not be used to endorse or promote
     18           1.1      manu  *    products derived from this software without specific prior written
     19           1.1      manu  *    permission.
     20           1.1      manu  *
     21           1.1      manu  * THIS SOFTWARE IS PROVIDED BY THE THE AUTHOR AND CONTRIBUTORS ``AS IS''
     22           1.1      manu  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
     23           1.1      manu  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     24           1.1      manu  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS
     25           1.1      manu  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     26           1.1      manu  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     27           1.1      manu  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     28           1.1      manu  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     29           1.1      manu  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     30           1.1      manu  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     31           1.1      manu  * POSSIBILITY OF SUCH DAMAGE.
     32           1.1      manu  */
     33           1.1      manu 
     34           1.1      manu #include <sys/cdefs.h>
     35           1.1      manu 
     36  1.15.2.1.2.1  wrstuden __KERNEL_RCSID(0, "$NetBSD: linux_machdep.c,v 1.15.2.1.2.1 2007/06/04 01:54:19 wrstuden Exp $");
     37           1.1      manu 
     38           1.1      manu #include <sys/param.h>
     39           1.1      manu #include <sys/types.h>
     40           1.1      manu #include <sys/systm.h>
     41           1.1      manu #include <sys/signal.h>
     42           1.1      manu #include <sys/exec.h>
     43           1.1      manu #include <sys/proc.h>
     44           1.1      manu #include <sys/ptrace.h> /* for process_read_fpregs() */
     45           1.1      manu #include <sys/user.h>
     46          1.10      manu #include <sys/wait.h>
     47           1.1      manu #include <sys/ucontext.h>
     48      1.15.2.1     pavel #include <sys/conf.h>
     49           1.1      manu 
     50           1.1      manu #include <machine/reg.h>
     51           1.1      manu #include <machine/pcb.h>
     52           1.1      manu #include <machine/fpu.h>
     53           1.1      manu #include <machine/mcontext.h>
     54           1.2      fvdl #include <machine/specialreg.h>
     55           1.2      fvdl #include <machine/vmparam.h>
     56           1.1      manu 
     57      1.15.2.1     pavel /*
     58      1.15.2.1     pavel  * To see whether wscons is configured (for virtual console ioctl calls).
     59      1.15.2.1     pavel  */
     60      1.15.2.1     pavel #if defined(_KERNEL_OPT)
     61      1.15.2.1     pavel #include "wsdisplay.h"
     62      1.15.2.1     pavel #endif
     63      1.15.2.1     pavel #if (NWSDISPLAY > 0)
     64      1.15.2.1     pavel #include <dev/wscons/wsconsio.h>
     65      1.15.2.1     pavel #include <dev/wscons/wsdisplay_usl_io.h>
     66      1.15.2.1     pavel #endif
     67      1.15.2.1     pavel 
     68      1.15.2.1     pavel 
     69           1.1      manu #include <compat/linux/common/linux_signal.h>
     70           1.1      manu #include <compat/linux/common/linux_errno.h>
     71           1.1      manu #include <compat/linux/common/linux_exec.h>
     72           1.1      manu #include <compat/linux/common/linux_ioctl.h>
     73           1.1      manu #include <compat/linux/common/linux_prctl.h>
     74           1.1      manu #include <compat/linux/common/linux_machdep.h>
     75           1.4      fvdl #include <compat/linux/linux_syscall.h>
     76           1.1      manu #include <compat/linux/linux_syscallargs.h>
     77           1.1      manu 
     78           1.5      fvdl static void linux_buildcontext(struct lwp *, void *, void *);
     79           1.5      fvdl 
     80           1.1      manu void
     81           1.1      manu linux_setregs(l, epp, stack)
     82           1.1      manu         struct lwp *l;
     83           1.1      manu 	struct exec_package *epp;
     84           1.1      manu 	u_long stack;
     85           1.1      manu {
     86           1.1      manu 	struct pcb *pcb = &l->l_addr->u_pcb;
     87           1.1      manu 	struct trapframe *tf;
     88           1.1      manu 
     89           1.1      manu 	/* If we were using the FPU, forget about it. */
     90           1.1      manu 	if (l->l_addr->u_pcb.pcb_fpcpu != NULL)
     91           1.1      manu 		fpusave_lwp(l, 0);
     92           1.1      manu 
     93           1.1      manu 	l->l_md.md_flags &= ~MDP_USEDFPU;
     94           1.1      manu 	pcb->pcb_flags = 0;
     95           1.1      manu 	pcb->pcb_savefpu.fp_fxsave.fx_fcw = __NetBSD_NPXCW__;
     96           1.1      manu 	pcb->pcb_savefpu.fp_fxsave.fx_mxcsr = __INITIAL_MXCSR__;
     97           1.1      manu 	pcb->pcb_savefpu.fp_fxsave.fx_mxcsr_mask = __INITIAL_MXCSR_MASK__;
     98           1.4      fvdl 	pcb->pcb_fs = 0;
     99           1.4      fvdl 	pcb->pcb_gs = 0;
    100           1.1      manu 
    101           1.1      manu 	l->l_proc->p_flag &= ~P_32;
    102           1.1      manu 
    103           1.1      manu 	tf = l->l_md.md_regs;
    104           1.1      manu 	tf->tf_rax = 0;
    105           1.1      manu 	tf->tf_rbx = 0;
    106           1.1      manu 	tf->tf_rcx = epp->ep_entry;
    107           1.1      manu 	tf->tf_rdx = 0;
    108           1.1      manu 	tf->tf_rsi = 0;
    109           1.1      manu 	tf->tf_rdi = 0;
    110           1.1      manu 	tf->tf_rbp = 0;
    111           1.1      manu 	tf->tf_rsp = stack;
    112           1.1      manu 	tf->tf_r8 = 0;
    113           1.1      manu 	tf->tf_r9 = 0;
    114           1.1      manu 	tf->tf_r10 = 0;
    115           1.1      manu 	tf->tf_r11 = 0;
    116           1.1      manu 	tf->tf_r12 = 0;
    117           1.1      manu 	tf->tf_r13 = 0;
    118           1.1      manu 	tf->tf_r14 = 0;
    119           1.1      manu 	tf->tf_r15 = 0;
    120           1.1      manu 	tf->tf_rip = epp->ep_entry;
    121           1.4      fvdl 	tf->tf_rflags = PSL_USERSET;
    122           1.4      fvdl 	tf->tf_cs = GSEL(GUCODE_SEL, SEL_UPL);
    123           1.4      fvdl 	tf->tf_ss = GSEL(GUDATA_SEL, SEL_UPL);
    124           1.1      manu 	tf->tf_ds = 0;
    125           1.1      manu 	tf->tf_es = 0;
    126           1.1      manu 	tf->tf_fs = 0;
    127           1.1      manu 	tf->tf_gs = 0;
    128           1.1      manu 
    129           1.1      manu 	return;
    130           1.1      manu }
    131           1.1      manu 
    132           1.1      manu void
    133           1.1      manu linux_sendsig(ksi, mask)
    134           1.1      manu 	const ksiginfo_t *ksi;
    135           1.1      manu 	const sigset_t *mask;
    136           1.1      manu {
    137           1.1      manu 	struct lwp *l = curlwp;
    138           1.1      manu 	struct proc *p = l->l_proc;
    139           1.1      manu 	struct sigacts *ps = p->p_sigacts;
    140           1.1      manu 	int onstack;
    141           1.1      manu 	int sig = ksi->ksi_signo;
    142           1.1      manu 	struct linux_rt_sigframe *sfp, sigframe;
    143           1.1      manu 	struct linux__fpstate *fpsp, fpstate;
    144           1.1      manu 	struct fpreg fpregs;
    145           1.1      manu 	struct trapframe *tf = l->l_md.md_regs;
    146           1.1      manu 	sig_t catcher = SIGACTION(p, sig).sa_handler;
    147           1.1      manu 	linux_sigset_t lmask;
    148           1.1      manu 	char *sp;
    149           1.1      manu 	int error;
    150           1.4      fvdl 
    151           1.1      manu 	/* Do we need to jump onto the signal stack? */
    152           1.1      manu 	onstack =
    153           1.1      manu 	    (p->p_sigctx.ps_sigstk.ss_flags & (SS_DISABLE | SS_ONSTACK)) == 0 &&
    154           1.1      manu 	    (SIGACTION(p, sig).sa_flags & SA_ONSTACK) != 0;
    155           1.1      manu 
    156           1.1      manu 	/* Allocate space for the signal handler context. */
    157           1.1      manu 	if (onstack)
    158           1.1      manu 		sp = ((caddr_t)p->p_sigctx.ps_sigstk.ss_sp +
    159           1.1      manu 		    p->p_sigctx.ps_sigstk.ss_size);
    160           1.1      manu 	else
    161           1.1      manu 		sp = (caddr_t)tf->tf_rsp - 128;
    162           1.1      manu 
    163           1.1      manu 
    164           1.1      manu 	/*
    165           1.1      manu 	 * Save FPU state, if any
    166           1.1      manu 	 */
    167           1.1      manu 	if (l->l_md.md_flags & MDP_USEDFPU) {
    168           1.1      manu 		sp = (char *)
    169           1.1      manu 		    (((long)sp - sizeof(struct linux__fpstate)) & ~0xfUL);
    170           1.1      manu 		fpsp = (struct linux__fpstate *)sp;
    171           1.1      manu 
    172           1.1      manu 		(void)process_read_fpregs(l, &fpregs);
    173           1.1      manu 		bzero(&fpstate, sizeof(fpstate));
    174           1.1      manu 
    175           1.1      manu 		fpstate.cwd = fpregs.fp_fcw;
    176           1.1      manu 		fpstate.swd = fpregs.fp_fsw;
    177           1.1      manu 		fpstate.twd = fpregs.fp_ftw;
    178           1.1      manu 		fpstate.fop = fpregs.fp_fop;
    179           1.1      manu 		fpstate.rip = fpregs.fp_rip;
    180           1.1      manu 		fpstate.rdp = fpregs.fp_rdp;
    181           1.1      manu 		fpstate.mxcsr = fpregs.fp_mxcsr;
    182           1.1      manu 		fpstate.mxcsr_mask = fpregs.fp_mxcsr_mask;
    183           1.1      manu 		memcpy(&fpstate.st_space, &fpregs.fp_st,
    184           1.1      manu 		    sizeof(fpstate.st_space));
    185           1.1      manu 		memcpy(&fpstate.xmm_space, &fpregs.fp_xmm,
    186           1.1      manu 		    sizeof(fpstate.xmm_space));
    187           1.1      manu 
    188           1.1      manu 		if ((error = copyout(&fpstate, fpsp, sizeof(fpstate))) != 0) {
    189           1.1      manu 			sigexit(l, SIGILL);
    190           1.1      manu 			return;
    191           1.1      manu 		}
    192           1.1      manu 	} else {
    193           1.1      manu 		fpsp = NULL;
    194           1.1      manu 	}
    195           1.1      manu 
    196           1.1      manu 	/*
    197           1.1      manu 	 * Populate the rt_sigframe
    198           1.1      manu 	 */
    199           1.1      manu 	sp = (char *)
    200           1.1      manu 	    ((((long)sp - sizeof(struct linux_rt_sigframe)) & ~0xfUL) - 8);
    201           1.1      manu 	sfp = (struct linux_rt_sigframe *)sp;
    202           1.1      manu 
    203           1.1      manu 	bzero(&sigframe, sizeof(sigframe));
    204           1.3      manu 	if (ps->sa_sigdesc[sig].sd_vers != 0)
    205           1.7      manu 		sigframe.pretcode =
    206           1.7      manu 		    (char *)(u_long)ps->sa_sigdesc[sig].sd_tramp;
    207           1.3      manu 	else
    208           1.3      manu 		sigframe.pretcode = NULL;
    209           1.1      manu 
    210           1.1      manu 	/*
    211           1.1      manu 	 * The user context
    212           1.1      manu 	 */
    213           1.1      manu 	sigframe.uc.luc_flags = 0;
    214           1.1      manu 	sigframe.uc.luc_link = NULL;
    215           1.1      manu 
    216           1.1      manu 	/* This is used regardless of SA_ONSTACK in Linux */
    217           1.1      manu 	sigframe.uc.luc_stack.ss_sp = p->p_sigctx.ps_sigstk.ss_sp;
    218           1.1      manu 	sigframe.uc.luc_stack.ss_size = p->p_sigctx.ps_sigstk.ss_size;
    219           1.1      manu 	sigframe.uc.luc_stack.ss_flags = 0;
    220           1.1      manu 	if (p->p_sigctx.ps_sigstk.ss_flags & SS_ONSTACK)
    221           1.1      manu 		sigframe.uc.luc_stack.ss_flags |= LINUX_SS_ONSTACK;
    222           1.1      manu 	if (p->p_sigctx.ps_sigstk.ss_flags & SS_DISABLE)
    223           1.1      manu 		sigframe.uc.luc_stack.ss_flags |= LINUX_SS_DISABLE;
    224           1.1      manu 
    225           1.1      manu 	sigframe.uc.luc_mcontext.r8 = tf->tf_r8;
    226           1.1      manu 	sigframe.uc.luc_mcontext.r9 = tf->tf_r9;
    227           1.1      manu 	sigframe.uc.luc_mcontext.r10 = tf->tf_r10;
    228           1.1      manu 	sigframe.uc.luc_mcontext.r11 = tf->tf_r11;
    229           1.1      manu 	sigframe.uc.luc_mcontext.r12 = tf->tf_r12;
    230           1.1      manu 	sigframe.uc.luc_mcontext.r13 = tf->tf_r13;
    231           1.1      manu 	sigframe.uc.luc_mcontext.r14 = tf->tf_r14;
    232           1.1      manu 	sigframe.uc.luc_mcontext.r15 = tf->tf_r15;
    233           1.1      manu 	sigframe.uc.luc_mcontext.rdi = tf->tf_rdi;
    234           1.1      manu 	sigframe.uc.luc_mcontext.rsi = tf->tf_rsi;
    235           1.1      manu 	sigframe.uc.luc_mcontext.rbp = tf->tf_rbp;
    236           1.1      manu 	sigframe.uc.luc_mcontext.rbx = tf->tf_rbx;
    237           1.1      manu 	sigframe.uc.luc_mcontext.rdx = tf->tf_rdx;
    238  1.15.2.1.2.1  wrstuden 	sigframe.uc.luc_mcontext.rax = tf->tf_rax;
    239           1.1      manu 	sigframe.uc.luc_mcontext.rcx = tf->tf_rcx;
    240           1.1      manu 	sigframe.uc.luc_mcontext.rsp = tf->tf_rsp;
    241           1.6      fvdl 	sigframe.uc.luc_mcontext.rip = tf->tf_rip;
    242           1.1      manu 	sigframe.uc.luc_mcontext.eflags = tf->tf_rflags;
    243           1.1      manu 	sigframe.uc.luc_mcontext.cs = tf->tf_cs;
    244           1.1      manu 	sigframe.uc.luc_mcontext.gs = tf->tf_gs;
    245           1.1      manu 	sigframe.uc.luc_mcontext.fs = tf->tf_fs;
    246           1.1      manu 	sigframe.uc.luc_mcontext.err = tf->tf_err;
    247           1.1      manu 	sigframe.uc.luc_mcontext.trapno = tf->tf_trapno;
    248           1.1      manu 	native_to_linux_sigset(&lmask, mask);
    249           1.1      manu 	sigframe.uc.luc_mcontext.oldmask = lmask.sig[0];
    250           1.1      manu 	sigframe.uc.luc_mcontext.cr2 = (long)l->l_addr->u_pcb.pcb_onfault;
    251           1.1      manu 	sigframe.uc.luc_mcontext.fpstate = fpsp;
    252           1.1      manu 	native_to_linux_sigset(&sigframe.uc.luc_sigmask, mask);
    253           1.1      manu 
    254           1.1      manu 	/*
    255           1.1      manu 	 * the siginfo structure
    256           1.1      manu 	 */
    257           1.1      manu 	sigframe.info.lsi_signo = native_to_linux_signo[sig];
    258           1.1      manu 	sigframe.info.lsi_errno = native_to_linux_errno[ksi->ksi_errno];
    259           1.1      manu 	sigframe.info.lsi_code = ksi->ksi_code;
    260           1.1      manu 
    261           1.1      manu 	/* XXX This is a rought conversion, taken from i386 code */
    262           1.1      manu 	switch (sigframe.info.lsi_signo) {
    263           1.1      manu 	case LINUX_SIGILL:
    264           1.1      manu 	case LINUX_SIGFPE:
    265           1.1      manu 	case LINUX_SIGSEGV:
    266           1.1      manu 	case LINUX_SIGBUS:
    267           1.1      manu 	case LINUX_SIGTRAP:
    268           1.1      manu 		sigframe.info._sifields._sigfault._addr = ksi->ksi_addr;
    269           1.1      manu 		break;
    270           1.1      manu 	case LINUX_SIGCHLD:
    271           1.1      manu 		sigframe.info._sifields._sigchld._pid = ksi->ksi_pid;
    272           1.1      manu 		sigframe.info._sifields._sigchld._uid = ksi->ksi_uid;
    273           1.1      manu 		sigframe.info._sifields._sigchld._utime = ksi->ksi_utime;
    274           1.1      manu 		sigframe.info._sifields._sigchld._stime = ksi->ksi_stime;
    275           1.9      manu 
    276           1.9      manu 		if (WCOREDUMP(ksi->ksi_status)) {
    277           1.9      manu 			sigframe.info.lsi_code = LINUX_CLD_DUMPED;
    278           1.9      manu 			sigframe.info._sifields._sigchld._status =
    279           1.9      manu 			    _WSTATUS(ksi->ksi_status);
    280           1.9      manu 		} else if (_WSTATUS(ksi->ksi_status)) {
    281           1.9      manu 			sigframe.info.lsi_code = LINUX_CLD_KILLED;
    282           1.9      manu 			sigframe.info._sifields._sigchld._status =
    283           1.9      manu 			    _WSTATUS(ksi->ksi_status);
    284           1.9      manu 		} else {
    285           1.9      manu 			sigframe.info.lsi_code = LINUX_CLD_EXITED;
    286           1.9      manu 			sigframe.info._sifields._sigchld._status =
    287           1.9      manu 			    ((ksi->ksi_status & 0xff00U) >> 8);
    288           1.9      manu 		}
    289           1.1      manu 		break;
    290           1.1      manu 	case LINUX_SIGIO:
    291           1.1      manu 		sigframe.info._sifields._sigpoll._band = ksi->ksi_band;
    292           1.1      manu 		sigframe.info._sifields._sigpoll._fd = ksi->ksi_fd;
    293           1.1      manu 		break;
    294           1.1      manu 	default:
    295           1.1      manu 		sigframe.info._sifields._sigchld._pid = ksi->ksi_pid;
    296           1.1      manu 		sigframe.info._sifields._sigchld._uid = ksi->ksi_uid;
    297           1.1      manu 		if ((sigframe.info.lsi_signo == LINUX_SIGALRM) ||
    298           1.1      manu 		    (sigframe.info.lsi_signo >= LINUX_SIGRTMIN))
    299           1.1      manu 			sigframe.info._sifields._timer._sigval.sival_ptr =
    300           1.1      manu 			     ksi->ksi_sigval.sival_ptr;
    301           1.1      manu 		break;
    302           1.1      manu 	}
    303           1.1      manu 
    304           1.1      manu 	if ((error = copyout(&sigframe, sp, sizeof(sigframe))) != 0) {
    305           1.1      manu 		sigexit(l, SIGILL);
    306           1.1      manu 		return;
    307           1.1      manu 	}
    308           1.1      manu 
    309           1.6      fvdl 	linux_buildcontext(l, catcher, sp);
    310           1.1      manu 	tf->tf_rdi = sigframe.info.lsi_signo;
    311           1.1      manu 	tf->tf_rax = 0;
    312           1.1      manu 	tf->tf_rsi = (long)&sfp->info;
    313           1.1      manu 	tf->tf_rdx = (long)&sfp->uc;
    314           1.1      manu 
    315           1.1      manu 	/*
    316           1.1      manu 	 * Remember we use signal stack
    317           1.1      manu 	 */
    318           1.1      manu 	if (onstack)
    319           1.1      manu 		p->p_sigctx.ps_sigstk.ss_flags |= SS_ONSTACK;
    320           1.1      manu 	return;
    321           1.1      manu }
    322           1.1      manu 
    323           1.1      manu int
    324           1.1      manu linux_sys_modify_ldt(l, v, retval)
    325           1.1      manu         struct lwp *l;
    326           1.1      manu         void *v;
    327           1.1      manu         register_t *retval;
    328           1.1      manu {
    329          1.14      manu 	printf("linux_sys_modify_ldt\n");
    330           1.1      manu 	return 0;
    331           1.1      manu }
    332           1.1      manu 
    333           1.1      manu int
    334           1.1      manu linux_sys_iopl(l, v, retval)
    335           1.1      manu         struct lwp *l;
    336           1.1      manu         void *v;
    337           1.1      manu         register_t *retval;
    338           1.1      manu {
    339           1.1      manu 	return 0;
    340           1.1      manu }
    341           1.1      manu 
    342           1.1      manu int
    343           1.1      manu linux_sys_ioperm(l, v, retval)
    344           1.1      manu         struct lwp *l;
    345           1.1      manu         void *v;
    346           1.1      manu         register_t *retval;
    347           1.1      manu {
    348           1.1      manu 	return 0;
    349           1.1      manu }
    350           1.1      manu 
    351           1.1      manu dev_t
    352           1.1      manu linux_fakedev(dev, raw)
    353           1.1      manu         dev_t dev;
    354           1.1      manu 	int raw;
    355           1.1      manu {
    356      1.15.2.1     pavel 
    357      1.15.2.1     pavel        extern const struct cdevsw ptc_cdevsw, pts_cdevsw;
    358      1.15.2.1     pavel        const struct cdevsw *cd = cdevsw_lookup(dev);
    359      1.15.2.1     pavel 
    360      1.15.2.1     pavel        if (raw) {
    361      1.15.2.1     pavel #if (NWSDISPLAY > 0)
    362      1.15.2.1     pavel 	       extern const struct cdevsw wsdisplay_cdevsw;
    363      1.15.2.1     pavel 	       if (cd == &wsdisplay_cdevsw)
    364      1.15.2.1     pavel 		       return makedev(LINUX_CONS_MAJOR, (minor(dev) + 1));
    365      1.15.2.1     pavel #endif
    366      1.15.2.1     pavel        }
    367      1.15.2.1     pavel 
    368      1.15.2.1     pavel        if (cd == &ptc_cdevsw)
    369      1.15.2.1     pavel 	       return makedev(LINUX_PTC_MAJOR, minor(dev));
    370      1.15.2.1     pavel        if (cd == &pts_cdevsw)
    371      1.15.2.1     pavel 	       return makedev(LINUX_PTS_MAJOR, minor(dev));
    372      1.15.2.1     pavel 
    373          1.15      manu 	return ((minor(dev) & 0xff) | ((major(dev) & 0xfff) << 8)
    374          1.15      manu 	    | (((unsigned long long int) (minor(dev) & ~0xff)) << 12)
    375          1.15      manu 	    | (((unsigned long long int) (major(dev) & ~0xfff)) << 32));
    376           1.1      manu }
    377           1.1      manu 
    378           1.1      manu int
    379          1.13  christos linux_machdepioctl(l, v, retval)
    380          1.13  christos         struct lwp *l;
    381           1.1      manu         void *v;
    382           1.1      manu         register_t *retval;
    383           1.1      manu {
    384           1.1      manu 	return 0;
    385           1.1      manu }
    386           1.1      manu 
    387           1.1      manu int
    388           1.1      manu linux_sys_rt_sigreturn(l, v, retval)
    389           1.1      manu         struct lwp *l;
    390           1.1      manu         void *v;
    391           1.1      manu         register_t *retval;
    392           1.1      manu {
    393           1.6      fvdl 	struct linux_ucontext *luctx;
    394           1.1      manu 	struct trapframe *tf = l->l_md.md_regs;
    395           1.1      manu 	struct linux_sigcontext *lsigctx;
    396           1.1      manu 	struct linux__fpstate fpstate;
    397           1.6      fvdl 	struct linux_rt_sigframe frame, *fp;
    398           1.1      manu 	ucontext_t uctx;
    399           1.1      manu 	mcontext_t *mctx;
    400           1.1      manu 	struct fxsave64 *fxsave;
    401           1.1      manu 	int error;
    402           1.1      manu 
    403           1.6      fvdl 	fp = (struct linux_rt_sigframe *)(tf->tf_rsp - 8);
    404           1.6      fvdl 	if ((error = copyin(fp, &frame, sizeof(frame))) != 0) {
    405           1.1      manu 		sigexit(l, SIGILL);
    406           1.1      manu 		return error;
    407           1.1      manu 	}
    408           1.6      fvdl 	luctx = &frame.uc;
    409           1.6      fvdl 	lsigctx = &luctx->luc_mcontext;
    410           1.1      manu 
    411           1.1      manu 	bzero(&uctx, sizeof(uctx));
    412           1.1      manu 	mctx = (mcontext_t *)&uctx.uc_mcontext;
    413           1.1      manu 	fxsave = (struct fxsave64 *)&mctx->__fpregs;
    414           1.1      manu 
    415           1.1      manu 	/*
    416           1.1      manu 	 * Set the flags. Linux always have CPU, stack and signal state,
    417           1.1      manu 	 * FPU is optional. uc_flags is not used to tell what we have.
    418           1.1      manu 	 */
    419           1.1      manu 	uctx.uc_flags = (_UC_SIGMASK|_UC_CPU|_UC_STACK|_UC_CLRSTACK);
    420           1.1      manu 	if (lsigctx->fpstate != NULL)
    421           1.1      manu 		uctx.uc_flags |= _UC_FPU;
    422           1.1      manu 	uctx.uc_link = NULL;
    423           1.1      manu 
    424           1.1      manu 	/*
    425           1.1      manu 	 * Signal set
    426           1.1      manu 	 */
    427           1.6      fvdl 	linux_to_native_sigset(&uctx.uc_sigmask, &luctx->luc_sigmask);
    428           1.1      manu 
    429           1.1      manu 	/*
    430           1.1      manu 	 * CPU state
    431           1.1      manu 	 */
    432           1.1      manu 	mctx->__gregs[_REG_R8] = lsigctx->r8;
    433           1.1      manu 	mctx->__gregs[_REG_R9] = lsigctx->r9;
    434           1.1      manu 	mctx->__gregs[_REG_R10] = lsigctx->r10;
    435           1.1      manu 	mctx->__gregs[_REG_R11] = lsigctx->r11;
    436           1.1      manu 	mctx->__gregs[_REG_R12] = lsigctx->r12;
    437           1.1      manu 	mctx->__gregs[_REG_R13] = lsigctx->r13;
    438           1.1      manu 	mctx->__gregs[_REG_R14] = lsigctx->r14;
    439           1.1      manu 	mctx->__gregs[_REG_R15] = lsigctx->r15;
    440           1.1      manu 	mctx->__gregs[_REG_RDI] = lsigctx->rdi;
    441           1.1      manu 	mctx->__gregs[_REG_RSI] = lsigctx->rsi;
    442           1.1      manu 	mctx->__gregs[_REG_RBP] = lsigctx->rbp;
    443           1.1      manu 	mctx->__gregs[_REG_RBX] = lsigctx->rbx;
    444  1.15.2.1.2.1  wrstuden 	mctx->__gregs[_REG_RAX] = lsigctx->rax;
    445           1.1      manu 	mctx->__gregs[_REG_RDX] = lsigctx->rdx;
    446           1.1      manu 	mctx->__gregs[_REG_RCX] = lsigctx->rcx;
    447           1.1      manu 	mctx->__gregs[_REG_RIP] = lsigctx->rip;
    448           1.1      manu 	mctx->__gregs[_REG_RFL] = lsigctx->eflags;
    449           1.1      manu 	mctx->__gregs[_REG_CS] = lsigctx->cs;
    450           1.1      manu 	mctx->__gregs[_REG_GS] = lsigctx->gs;
    451           1.1      manu 	mctx->__gregs[_REG_FS] = lsigctx->fs;
    452           1.1      manu 	mctx->__gregs[_REG_ERR] = lsigctx->err;
    453           1.1      manu 	mctx->__gregs[_REG_TRAPNO] = lsigctx->trapno;
    454           1.1      manu 	mctx->__gregs[_REG_ES] = tf->tf_es;
    455           1.1      manu 	mctx->__gregs[_REG_DS] = tf->tf_ds;
    456           1.1      manu 	mctx->__gregs[_REG_URSP] = lsigctx->rsp; /* XXX */
    457           1.1      manu 	mctx->__gregs[_REG_SS] = tf->tf_ss;
    458           1.1      manu 
    459           1.1      manu 	/*
    460           1.1      manu 	 * FPU state
    461           1.1      manu 	 */
    462           1.1      manu 	if (lsigctx->fpstate != NULL) {
    463           1.1      manu 		error = copyin(lsigctx->fpstate, &fpstate, sizeof(fpstate));
    464           1.1      manu 		if (error != 0) {
    465           1.1      manu 			sigexit(l, SIGILL);
    466           1.1      manu 			return error;
    467           1.1      manu 		}
    468           1.1      manu 
    469           1.1      manu 		fxsave->fx_fcw = fpstate.cwd;
    470           1.1      manu 		fxsave->fx_fsw = fpstate.swd;
    471           1.1      manu 		fxsave->fx_ftw = fpstate.twd;
    472           1.1      manu 		fxsave->fx_fop = fpstate.fop;
    473           1.1      manu 		fxsave->fx_rip = fpstate.rip;
    474           1.1      manu 		fxsave->fx_rdp = fpstate.rdp;
    475           1.1      manu 		fxsave->fx_mxcsr = fpstate.mxcsr;
    476           1.1      manu 		fxsave->fx_mxcsr_mask = fpstate.mxcsr_mask;
    477           1.1      manu 		memcpy(&fxsave->fx_st, &fpstate.st_space,
    478           1.1      manu 		    sizeof(fxsave->fx_st));
    479           1.1      manu 		memcpy(&fxsave->fx_xmm, &fpstate.xmm_space,
    480           1.1      manu 		    sizeof(fxsave->fx_xmm));
    481           1.1      manu 	}
    482           1.1      manu 
    483           1.1      manu 	/*
    484           1.1      manu 	 * And the stack
    485           1.1      manu 	 */
    486           1.1      manu 	uctx.uc_stack.ss_flags = 0;
    487           1.6      fvdl 	if (luctx->luc_stack.ss_flags & LINUX_SS_ONSTACK);
    488           1.1      manu 		uctx.uc_stack.ss_flags = SS_ONSTACK;
    489           1.1      manu 
    490           1.6      fvdl 	if (luctx->luc_stack.ss_flags & LINUX_SS_DISABLE);
    491           1.1      manu 		uctx.uc_stack.ss_flags = SS_DISABLE;
    492           1.1      manu 
    493           1.6      fvdl 	uctx.uc_stack.ss_sp = luctx->luc_stack.ss_sp;
    494           1.6      fvdl 	uctx.uc_stack.ss_size = luctx->luc_stack.ss_size;
    495           1.1      manu 
    496           1.1      manu 	/*
    497           1.1      manu 	 * And let setucontext deal with that.
    498           1.1      manu 	 */
    499  1.15.2.1.2.1  wrstuden 	error = setucontext(l, &uctx);
    500  1.15.2.1.2.1  wrstuden 	if (error)
    501  1.15.2.1.2.1  wrstuden 		return error;
    502  1.15.2.1.2.1  wrstuden 
    503  1.15.2.1.2.1  wrstuden 	return EJUSTRETURN;
    504           1.1      manu }
    505           1.1      manu 
    506           1.1      manu int
    507           1.1      manu linux_sys_arch_prctl(l, v, retval)
    508           1.1      manu 	struct lwp *l;
    509           1.1      manu 	void *v;
    510           1.1      manu 	register_t *retval;
    511           1.1      manu {
    512           1.1      manu 	struct linux_sys_arch_prctl_args /* {
    513           1.1      manu 		syscallarg(int) code;
    514           1.1      manu 		syscallarg(unsigned long) addr;
    515           1.1      manu 	} */ *uap = v;
    516           1.2      fvdl 	struct pcb *pcb = &l->l_addr->u_pcb;
    517           1.2      fvdl 	struct trapframe *tf = l->l_md.md_regs;
    518           1.1      manu 	int error;
    519           1.2      fvdl 	uint64_t taddr;
    520           1.1      manu 
    521           1.1      manu 	switch(SCARG(uap, code)) {
    522           1.1      manu 	case LINUX_ARCH_SET_GS:
    523           1.2      fvdl 		taddr = SCARG(uap, addr);
    524           1.2      fvdl 		if (taddr >= VM_MAXUSER_ADDRESS)
    525           1.2      fvdl 			return EINVAL;
    526           1.2      fvdl 		pcb->pcb_gs = taddr;
    527           1.2      fvdl 		pcb->pcb_flags |= PCB_GS64;
    528           1.2      fvdl 		if (l == curlwp)
    529           1.2      fvdl 			wrmsr(MSR_KERNELGSBASE, taddr);
    530           1.1      manu 		break;
    531           1.1      manu 
    532           1.1      manu 	case LINUX_ARCH_GET_GS:
    533           1.2      fvdl 		if (pcb->pcb_flags & PCB_GS64)
    534           1.2      fvdl 			taddr = pcb->pcb_gs;
    535           1.2      fvdl 		else {
    536           1.2      fvdl 			error = memseg_baseaddr(l, tf->tf_fs, NULL, 0, &taddr);
    537           1.2      fvdl 			if (error != 0)
    538           1.2      fvdl 				return error;
    539           1.2      fvdl 		}
    540           1.2      fvdl 		error = copyout(&taddr, (char *)SCARG(uap, addr), 8);
    541           1.2      fvdl 		if (error != 0)
    542           1.1      manu 			return error;
    543           1.1      manu 		break;
    544           1.1      manu 
    545           1.1      manu 	case LINUX_ARCH_SET_FS:
    546           1.2      fvdl 		taddr = SCARG(uap, addr);
    547           1.2      fvdl 		if (taddr >= VM_MAXUSER_ADDRESS)
    548           1.2      fvdl 			return EINVAL;
    549           1.2      fvdl 		pcb->pcb_fs = taddr;
    550           1.2      fvdl 		pcb->pcb_flags |= PCB_FS64;
    551           1.2      fvdl 		if (l == curlwp)
    552           1.2      fvdl 			wrmsr(MSR_FSBASE, taddr);
    553           1.1      manu 		break;
    554           1.1      manu 
    555           1.1      manu 	case LINUX_ARCH_GET_FS:
    556           1.2      fvdl 		if (pcb->pcb_flags & PCB_FS64)
    557           1.2      fvdl 			taddr = pcb->pcb_fs;
    558           1.2      fvdl 		else {
    559           1.2      fvdl 			error = memseg_baseaddr(l, tf->tf_fs, NULL, 0, &taddr);
    560           1.2      fvdl 			if (error != 0)
    561           1.2      fvdl 				return error;
    562           1.2      fvdl 		}
    563           1.2      fvdl 		error = copyout(&taddr, (char *)SCARG(uap, addr), 8);
    564           1.2      fvdl 		if (error != 0)
    565           1.1      manu 			return error;
    566           1.1      manu 		break;
    567           1.1      manu 
    568           1.1      manu 	default:
    569           1.1      manu #ifdef DEBUG_LINUX
    570           1.1      manu 		printf("linux_sys_arch_prctl: unexpected code %d\n",
    571           1.1      manu 		    SCARG(uap, code));
    572           1.1      manu #endif
    573           1.1      manu 		return EINVAL;
    574           1.1      manu 	}
    575           1.1      manu 
    576           1.1      manu 	return 0;
    577           1.1      manu }
    578           1.4      fvdl 
    579           1.4      fvdl const int linux_vsyscall_to_syscall[] = {
    580           1.4      fvdl 	LINUX_SYS_gettimeofday,
    581           1.4      fvdl 	LINUX_SYS_time,
    582           1.4      fvdl 	LINUX_SYS_nosys,
    583           1.4      fvdl 	LINUX_SYS_nosys,
    584           1.4      fvdl };
    585           1.4      fvdl 
    586           1.4      fvdl int
    587           1.4      fvdl linux_usertrap(struct lwp *l, vaddr_t trapaddr, void *arg)
    588           1.4      fvdl {
    589           1.4      fvdl 	struct trapframe *tf = arg;
    590           1.4      fvdl 	uint64_t retaddr;
    591           1.4      fvdl 	int vsyscallnr;
    592           1.4      fvdl 
    593           1.4      fvdl 	/*
    594           1.4      fvdl 	 * Check for a vsyscall. %rip must be the fault address,
    595           1.4      fvdl 	 * and the address must be in the Linux vsyscall area.
    596           1.4      fvdl 	 * Also, vsyscalls are only done at 1024-byte boundaries.
    597           1.4      fvdl 	 */
    598           1.4      fvdl 
    599           1.4      fvdl 	if (__predict_true(trapaddr < LINUX_VSYSCALL_START))
    600           1.4      fvdl 		return 0;
    601           1.4      fvdl 
    602           1.4      fvdl 	if (trapaddr != tf->tf_rip)
    603           1.4      fvdl 		return 0;
    604           1.4      fvdl 
    605           1.4      fvdl 	if ((tf->tf_rip & (LINUX_VSYSCALL_SIZE - 1)) != 0)
    606           1.4      fvdl 		return 0;
    607           1.4      fvdl 
    608           1.4      fvdl 	vsyscallnr = (tf->tf_rip - LINUX_VSYSCALL_START) / LINUX_VSYSCALL_SIZE;
    609           1.4      fvdl 
    610           1.4      fvdl 	if (vsyscallnr > LINUX_VSYSCALL_MAXNR)
    611           1.4      fvdl 		return 0;
    612           1.4      fvdl 
    613           1.4      fvdl 	/*
    614           1.4      fvdl 	 * Get the return address from the top of the stack,
    615           1.4      fvdl 	 * and fix up the return address.
    616           1.4      fvdl 	 * This assumes the faulting instruction was callq *reg,
    617           1.4      fvdl 	 * which is the only way that vsyscalls are ever entered.
    618           1.4      fvdl 	 */
    619           1.4      fvdl 	if (copyin((void *)tf->tf_rsp, &retaddr, sizeof retaddr) != 0)
    620           1.4      fvdl 		return 0;
    621           1.4      fvdl 	tf->tf_rip = retaddr;
    622           1.4      fvdl 	tf->tf_rax = linux_vsyscall_to_syscall[vsyscallnr];
    623           1.4      fvdl 	tf->tf_rsp += 8;	/* "pop" the return address */
    624           1.4      fvdl 
    625           1.4      fvdl #if 0
    626           1.4      fvdl 	printf("usertrap: rip %p rsp %p retaddr %p vsys %d sys %d\n",
    627           1.4      fvdl 	    (void *)tf->tf_rip, (void *)tf->tf_rsp, (void *)retaddr,
    628           1.4      fvdl 	    vsyscallnr, (int)tf->tf_rax);
    629           1.4      fvdl #endif
    630           1.4      fvdl 
    631           1.4      fvdl 	(*l->l_proc->p_md.md_syscall)(tf);
    632           1.4      fvdl 
    633           1.4      fvdl 	return 1;
    634           1.4      fvdl }
    635           1.5      fvdl 
    636           1.5      fvdl static void
    637           1.5      fvdl linux_buildcontext(struct lwp *l, void *catcher, void *f)
    638           1.5      fvdl {
    639           1.5      fvdl 	struct trapframe *tf = l->l_md.md_regs;
    640           1.5      fvdl 
    641           1.5      fvdl 	tf->tf_ds = GSEL(GUDATA_SEL, SEL_UPL);
    642           1.5      fvdl 	tf->tf_rip = (u_int64_t)catcher;
    643           1.5      fvdl 	tf->tf_cs = GSEL(GUCODE_SEL, SEL_UPL);
    644           1.5      fvdl 	tf->tf_rflags &= ~(PSL_T|PSL_VM|PSL_AC);
    645           1.5      fvdl 	tf->tf_rsp = (u_int64_t)f;
    646           1.5      fvdl 	tf->tf_ss = GSEL(GUDATA_SEL, SEL_UPL);
    647           1.5      fvdl }
    648          1.11      manu 
    649          1.14      manu void *
    650          1.11      manu linux_get_newtls(l)
    651          1.11      manu 	struct lwp *l;
    652          1.11      manu {
    653          1.11      manu 	struct trapframe *tf = l->l_md.md_regs;
    654          1.11      manu 
    655          1.14      manu 	return (void *)tf->tf_r8;
    656          1.11      manu }
    657          1.11      manu 
    658          1.11      manu int
    659          1.11      manu linux_set_newtls(l, tls)
    660          1.11      manu 	struct lwp *l;
    661          1.14      manu 	void *tls;
    662          1.11      manu {
    663          1.11      manu 	struct linux_sys_arch_prctl_args cup;
    664          1.11      manu 	register_t retval;
    665          1.11      manu 
    666          1.11      manu 	SCARG(&cup, code) = LINUX_ARCH_SET_FS;
    667          1.14      manu 	SCARG(&cup, addr) = (unsigned long)tls;
    668          1.11      manu 
    669          1.11      manu 	return linux_sys_arch_prctl(l, &cup, &retval);
    670          1.11      manu }
    671