Home | History | Annotate | Line # | Download | only in i386
linux_machdep.c revision 1.62.2.8
      1 /*	$NetBSD: linux_machdep.c,v 1.62.2.8 2002/04/17 00:04:57 nathanw Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 1995, 2000 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Frank van der Linden.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  * 3. All advertising materials mentioning features or use of this software
     19  *    must display the following acknowledgement:
     20  *	This product includes software developed by the NetBSD
     21  *	Foundation, Inc. and its contributors.
     22  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23  *    contributors may be used to endorse or promote products derived
     24  *    from this software without specific prior written permission.
     25  *
     26  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36  * POSSIBILITY OF SUCH DAMAGE.
     37  */
     38 
     39 #include <sys/cdefs.h>
     40 __KERNEL_RCSID(0, "$NetBSD: linux_machdep.c,v 1.62.2.8 2002/04/17 00:04:57 nathanw Exp $");
     41 
     42 #if defined(_KERNEL_OPT)
     43 #include "opt_vm86.h"
     44 #include "opt_user_ldt.h"
     45 #endif
     46 
     47 #include <sys/param.h>
     48 #include <sys/systm.h>
     49 #include <sys/signalvar.h>
     50 #include <sys/kernel.h>
     51 #include <sys/map.h>
     52 #include <sys/lwp.h>
     53 #include <sys/proc.h>
     54 #include <sys/user.h>
     55 #include <sys/buf.h>
     56 #include <sys/reboot.h>
     57 #include <sys/conf.h>
     58 #include <sys/exec.h>
     59 #include <sys/file.h>
     60 #include <sys/callout.h>
     61 #include <sys/malloc.h>
     62 #include <sys/mbuf.h>
     63 #include <sys/msgbuf.h>
     64 #include <sys/mount.h>
     65 #include <sys/vnode.h>
     66 #include <sys/device.h>
     67 #include <sys/syscallargs.h>
     68 #include <sys/filedesc.h>
     69 #include <sys/exec_elf.h>
     70 #include <sys/disklabel.h>
     71 #include <sys/ioctl.h>
     72 #include <miscfs/specfs/specdev.h>
     73 
     74 #include <compat/linux/common/linux_types.h>
     75 #include <compat/linux/common/linux_signal.h>
     76 #include <compat/linux/common/linux_util.h>
     77 #include <compat/linux/common/linux_ioctl.h>
     78 #include <compat/linux/common/linux_hdio.h>
     79 #include <compat/linux/common/linux_exec.h>
     80 #include <compat/linux/common/linux_machdep.h>
     81 
     82 #include <compat/linux/linux_syscallargs.h>
     83 
     84 #include <machine/cpu.h>
     85 #include <machine/cpufunc.h>
     86 #include <machine/psl.h>
     87 #include <machine/reg.h>
     88 #include <machine/segments.h>
     89 #include <machine/specialreg.h>
     90 #include <machine/sysarch.h>
     91 #include <machine/vm86.h>
     92 #include <machine/vmparam.h>
     93 
     94 /*
     95  * To see whether wscons is configured (for virtual console ioctl calls).
     96  */
     97 #if defined(_KERNEL_OPT)
     98 #include "wsdisplay.h"
     99 #endif
    100 #if (NWSDISPLAY > 0)
    101 #include <dev/wscons/wsconsio.h>
    102 #include <dev/wscons/wsdisplay_usl_io.h>
    103 #if defined(_KERNEL_OPT)
    104 #include "opt_xserver.h"
    105 #endif
    106 #endif
    107 
    108 #ifdef USER_LDT
    109 #include <machine/cpu.h>
    110 int linux_read_ldt __P((struct lwp *, struct linux_sys_modify_ldt_args *,
    111     register_t *));
    112 int linux_write_ldt __P((struct lwp *, struct linux_sys_modify_ldt_args *,
    113     register_t *));
    114 #endif
    115 
    116 #ifdef DEBUG_LINUX
    117 #define DPRINTF(a) uprintf a
    118 #else
    119 #define DPRINTF(a)
    120 #endif
    121 
    122 static struct biosdisk_info *fd2biosinfo __P((struct proc *, struct file *));
    123 extern struct disklist *i386_alldisks;
    124 extern const char *findblkname __P((int));
    125 
    126 /*
    127  * Deal with some i386-specific things in the Linux emulation code.
    128  */
    129 
    130 void
    131 linux_setregs(l, epp, stack)
    132 	struct lwp *l;
    133 	struct exec_package *epp;
    134 	u_long stack;
    135 {
    136 	struct pcb *pcb = &l->l_addr->u_pcb;
    137 	struct trapframe *tf;
    138 
    139 #if NNPX > 0
    140 	/* If we were using the FPU, forget about it. */
    141 	if (npxproc == l)
    142 		npxdrop();
    143 #endif
    144 
    145 #ifdef USER_LDT
    146 	pmap_ldt_cleanup(l);
    147 #endif
    148 
    149 	l->l_md.md_flags &= ~MDP_USEDFPU;
    150 	pcb->pcb_flags = 0;
    151 
    152 	if (i386_use_fxsave) {
    153 		pcb->pcb_savefpu.sv_xmm.sv_env.en_cw = __Linux_NPXCW__;
    154 		pcb->pcb_savefpu.sv_xmm.sv_env.en_mxcsr = __INITIAL_MXCSR__;
    155 	} else
    156 		pcb->pcb_savefpu.sv_87.sv_env.en_cw = __Linux_NPXCW__;
    157 
    158 	tf = l->l_md.md_regs;
    159 	tf->tf_gs = GSEL(GUDATA_SEL, SEL_UPL);
    160 	tf->tf_fs = GSEL(GUDATA_SEL, SEL_UPL);
    161 	tf->tf_es = GSEL(GUDATA_SEL, SEL_UPL);
    162 	tf->tf_ds = GSEL(GUDATA_SEL, SEL_UPL);
    163 	tf->tf_edi = 0;
    164 	tf->tf_esi = 0;
    165 	tf->tf_ebp = 0;
    166 	tf->tf_ebx = (int)l->l_proc->p_psstr;
    167 	tf->tf_edx = 0;
    168 	tf->tf_ecx = 0;
    169 	tf->tf_eax = 0;
    170 	tf->tf_eip = epp->ep_entry;
    171 	tf->tf_cs = GSEL(GUCODE_SEL, SEL_UPL);
    172 	tf->tf_eflags = PSL_USERSET;
    173 	tf->tf_esp = stack;
    174 	tf->tf_ss = GSEL(GUDATA_SEL, SEL_UPL);
    175 }
    176 
    177 /*
    178  * Send an interrupt to process.
    179  *
    180  * Stack is set up to allow sigcode stored
    181  * in u. to call routine, followed by kcall
    182  * to sigreturn routine below.  After sigreturn
    183  * resets the signal mask, the stack, and the
    184  * frame pointer, it returns to the user
    185  * specified pc, psl.
    186  */
    187 
    188 void
    189 linux_sendsig(catcher, sig, mask, code)
    190 	sig_t catcher;
    191 	int sig;
    192 	sigset_t *mask;
    193 	u_long code;
    194 {
    195 	struct lwp *l = curproc;
    196 	struct proc *p = l->l_proc;
    197 	struct trapframe *tf;
    198 	struct linux_sigframe *fp, frame;
    199 	int onstack;
    200 
    201 	tf = l->l_md.md_regs;
    202 	/* Do we need to jump onto the signal stack? */
    203 	onstack =
    204 	    (p->p_sigctx.ps_sigstk.ss_flags & (SS_DISABLE | SS_ONSTACK)) == 0 &&
    205 	    (SIGACTION(p, sig).sa_flags & SA_ONSTACK) != 0;
    206 
    207 	/* Allocate space for the signal handler context. */
    208 	if (onstack)
    209 		fp = (struct linux_sigframe *)((caddr_t)p->p_sigctx.ps_sigstk.ss_sp +
    210 					  p->p_sigctx.ps_sigstk.ss_size);
    211 	else
    212 		fp = (struct linux_sigframe *)tf->tf_esp;
    213 	fp--;
    214 
    215 	/* Build stack frame for signal trampoline. */
    216 	frame.sf_handler = catcher;
    217 	frame.sf_sig = native_to_linux_signo[sig];
    218 
    219 	/* Save register context. */
    220 #ifdef VM86
    221 	if (tf->tf_eflags & PSL_VM) {
    222 		frame.sf_sc.sc_gs = tf->tf_vm86_gs;
    223 		frame.sf_sc.sc_fs = tf->tf_vm86_fs;
    224 		frame.sf_sc.sc_es = tf->tf_vm86_es;
    225 		frame.sf_sc.sc_ds = tf->tf_vm86_ds;
    226 		frame.sf_sc.sc_eflags = get_vflags(l);
    227 	} else
    228 #endif
    229 	{
    230 		frame.sf_sc.sc_gs = tf->tf_gs;
    231 		frame.sf_sc.sc_fs = tf->tf_fs;
    232 		frame.sf_sc.sc_es = tf->tf_es;
    233 		frame.sf_sc.sc_ds = tf->tf_ds;
    234 		frame.sf_sc.sc_eflags = tf->tf_eflags;
    235 	}
    236 	frame.sf_sc.sc_edi = tf->tf_edi;
    237 	frame.sf_sc.sc_esi = tf->tf_esi;
    238 	frame.sf_sc.sc_ebp = tf->tf_ebp;
    239 	frame.sf_sc.sc_ebx = tf->tf_ebx;
    240 	frame.sf_sc.sc_edx = tf->tf_edx;
    241 	frame.sf_sc.sc_ecx = tf->tf_ecx;
    242 	frame.sf_sc.sc_eax = tf->tf_eax;
    243 	frame.sf_sc.sc_eip = tf->tf_eip;
    244 	frame.sf_sc.sc_cs = tf->tf_cs;
    245 	frame.sf_sc.sc_esp_at_signal = tf->tf_esp;
    246 	frame.sf_sc.sc_ss = tf->tf_ss;
    247 	frame.sf_sc.sc_err = tf->tf_err;
    248 	frame.sf_sc.sc_trapno = tf->tf_trapno;
    249 	frame.sf_sc.sc_cr2 = l->l_addr->u_pcb.pcb_cr2;
    250 
    251 	/* Save signal stack. */
    252 	/* Linux doesn't save the onstack flag in sigframe */
    253 
    254 	/* Save signal mask. */
    255 	native_to_linux_old_sigset(&frame.sf_sc.sc_mask, mask);
    256 
    257 	if (copyout(&frame, fp, sizeof(frame)) != 0) {
    258 		/*
    259 		 * Process has trashed its stack; give it an illegal
    260 		 * instruction to halt it in its tracks.
    261 		 */
    262 		sigexit(l, SIGILL);
    263 		/* NOTREACHED */
    264 	}
    265 
    266 	/*
    267 	 * Build context to run handler in.
    268 	 */
    269 	tf->tf_gs = GSEL(GUDATA_SEL, SEL_UPL);
    270 	tf->tf_fs = GSEL(GUDATA_SEL, SEL_UPL);
    271 	tf->tf_es = GSEL(GUDATA_SEL, SEL_UPL);
    272 	tf->tf_ds = GSEL(GUDATA_SEL, SEL_UPL);
    273 	tf->tf_eip = (int)p->p_sigctx.ps_sigcode;
    274 	tf->tf_cs = GSEL(GUCODE_SEL, SEL_UPL);
    275 	tf->tf_eflags &= ~(PSL_T|PSL_VM|PSL_AC);
    276 	tf->tf_esp = (int)fp;
    277 	tf->tf_ss = GSEL(GUDATA_SEL, SEL_UPL);
    278 
    279 	/* Remember that we're now on the signal stack. */
    280 	if (onstack)
    281 		p->p_sigctx.ps_sigstk.ss_flags |= SS_ONSTACK;
    282 }
    283 
    284 /*
    285  * System call to cleanup state after a signal
    286  * has been taken.  Reset signal mask and
    287  * stack state from context left by sendsig (above).
    288  * Return to previous pc and psl as specified by
    289  * context left by sendsig. Check carefully to
    290  * make sure that the user has not modified the
    291  * psl to gain improper privileges or to cause
    292  * a machine fault.
    293  */
    294 int
    295 linux_sys_rt_sigreturn(l, v, retval)
    296 	struct lwp *l;
    297 	void *v;
    298 	register_t *retval;
    299 {
    300 	/* XXX XAX write me */
    301 	return(ENOSYS);
    302 }
    303 
    304 int
    305 linux_sys_sigreturn(l, v, retval)
    306 	struct lwp *l;
    307 	void *v;
    308 	register_t *retval;
    309 {
    310 	struct linux_sys_sigreturn_args /* {
    311 		syscallarg(struct linux_sigcontext *) scp;
    312 	} */ *uap = v;
    313 	struct proc *p = l->l_proc;
    314 	struct linux_sigcontext *scp, context;
    315 	struct trapframe *tf;
    316 	sigset_t mask;
    317 	ssize_t ss_gap;
    318 
    319 	/*
    320 	 * The trampoline code hands us the context.
    321 	 * It is unsafe to keep track of it ourselves, in the event that a
    322 	 * program jumps out of a signal handler.
    323 	 */
    324 	scp = SCARG(uap, scp);
    325 	if (copyin((caddr_t)scp, &context, sizeof(*scp)) != 0)
    326 		return (EFAULT);
    327 
    328 	/* Restore register context. */
    329 	tf = l->l_md.md_regs;
    330 #ifdef VM86
    331 	if (context.sc_eflags & PSL_VM) {
    332 		tf->tf_vm86_gs = context.sc_gs;
    333 		tf->tf_vm86_fs = context.sc_fs;
    334 		tf->tf_vm86_es = context.sc_es;
    335 		tf->tf_vm86_ds = context.sc_ds;
    336 		set_vflags(l, context.sc_eflags);
    337 	} else
    338 #endif
    339 	{
    340 		/*
    341 		 * Check for security violations.  If we're returning to
    342 		 * protected mode, the CPU will validate the segment registers
    343 		 * automatically and generate a trap on violations.  We handle
    344 		 * the trap, rather than doing all of the checking here.
    345 		 */
    346 		if (((context.sc_eflags ^ tf->tf_eflags) & PSL_USERSTATIC) != 0 ||
    347 		    !USERMODE(context.sc_cs, context.sc_eflags))
    348 			return (EINVAL);
    349 
    350 		tf->tf_gs = context.sc_gs;
    351 		tf->tf_fs = context.sc_fs;
    352 		tf->tf_es = context.sc_es;
    353 		tf->tf_ds = context.sc_ds;
    354 		tf->tf_eflags = context.sc_eflags;
    355 	}
    356 	tf->tf_edi = context.sc_edi;
    357 	tf->tf_esi = context.sc_esi;
    358 	tf->tf_ebp = context.sc_ebp;
    359 	tf->tf_ebx = context.sc_ebx;
    360 	tf->tf_edx = context.sc_edx;
    361 	tf->tf_ecx = context.sc_ecx;
    362 	tf->tf_eax = context.sc_eax;
    363 	tf->tf_eip = context.sc_eip;
    364 	tf->tf_cs = context.sc_cs;
    365 	tf->tf_esp = context.sc_esp_at_signal;
    366 	tf->tf_ss = context.sc_ss;
    367 
    368 	/* Restore signal stack. */
    369 	/*
    370 	 * Linux really does it this way; it doesn't have space in sigframe
    371 	 * to save the onstack flag.
    372 	 */
    373 	ss_gap = (ssize_t)
    374 	    ((caddr_t) context.sc_esp_at_signal - (caddr_t) p->p_sigctx.ps_sigstk.ss_sp);
    375 	if (ss_gap >= 0  && ss_gap < p->p_sigctx.ps_sigstk.ss_size)
    376 		p->p_sigctx.ps_sigstk.ss_flags |= SS_ONSTACK;
    377 	else
    378 		p->p_sigctx.ps_sigstk.ss_flags &= ~SS_ONSTACK;
    379 
    380 	/* Restore signal mask. */
    381 	linux_old_to_native_sigset(&mask, &context.sc_mask);
    382 	(void) sigprocmask1(p, SIG_SETMASK, &mask, 0);
    383 
    384 	return (EJUSTRETURN);
    385 }
    386 
    387 #ifdef USER_LDT
    388 
    389 int
    390 linux_read_ldt(l, uap, retval)
    391 	struct lwp *l;
    392 	struct linux_sys_modify_ldt_args /* {
    393 		syscallarg(int) func;
    394 		syscallarg(void *) ptr;
    395 		syscallarg(size_t) bytecount;
    396 	} */ *uap;
    397 	register_t *retval;
    398 {
    399 	struct proc *p = l->l_proc;
    400 	struct i386_get_ldt_args gl;
    401 	int error;
    402 	caddr_t sg;
    403 	char *parms;
    404 
    405 	DPRINTF(("linux_read_ldt!"));
    406 	sg = stackgap_init(p, 0);
    407 
    408 	gl.start = 0;
    409 	gl.desc = SCARG(uap, ptr);
    410 	gl.num = SCARG(uap, bytecount) / sizeof(union descriptor);
    411 
    412 	parms = stackgap_alloc(p, &sg, sizeof(gl));
    413 
    414 	if ((error = copyout(&gl, parms, sizeof(gl))) != 0)
    415 		return (error);
    416 
    417 	if ((error = i386_get_ldt(l, parms, retval)) != 0)
    418 		return (error);
    419 
    420 	*retval *= sizeof(union descriptor);
    421 	return (0);
    422 }
    423 
    424 struct linux_ldt_info {
    425 	u_int entry_number;
    426 	u_long base_addr;
    427 	u_int limit;
    428 	u_int seg_32bit:1;
    429 	u_int contents:2;
    430 	u_int read_exec_only:1;
    431 	u_int limit_in_pages:1;
    432 	u_int seg_not_present:1;
    433 	u_int useable:1;
    434 };
    435 
    436 int
    437 linux_write_ldt(l, uap, retval)
    438 	struct lwp *l;
    439 	struct linux_sys_modify_ldt_args /* {
    440 		syscallarg(int) func;
    441 		syscallarg(void *) ptr;
    442 		syscallarg(size_t) bytecount;
    443 	} */ *uap;
    444 	register_t *retval;
    445 {
    446 	struct proc *p = l->l_proc;
    447 	struct linux_ldt_info ldt_info;
    448 	struct segment_descriptor sd;
    449 	struct i386_set_ldt_args sl;
    450 	int error;
    451 	caddr_t sg;
    452 	char *parms;
    453 	int oldmode = (int)retval[0];
    454 
    455 	DPRINTF(("linux_write_ldt %d\n", oldmode));
    456 	if (SCARG(uap, bytecount) != sizeof(ldt_info))
    457 		return (EINVAL);
    458 	if ((error = copyin(SCARG(uap, ptr), &ldt_info, sizeof(ldt_info))) != 0)
    459 		return error;
    460 	if (ldt_info.entry_number >= 8192)
    461 		return (EINVAL);
    462 	if (ldt_info.contents == 3) {
    463 		if (oldmode)
    464 			return (EINVAL);
    465 		if (ldt_info.seg_not_present)
    466 			return (EINVAL);
    467 	}
    468 
    469 	if (ldt_info.base_addr == 0 && ldt_info.limit == 0 &&
    470 	    (oldmode || (ldt_info.contents == 0 &&
    471 	    ldt_info.read_exec_only == 1 && ldt_info.seg_32bit == 0 &&
    472 	    ldt_info.limit_in_pages == 0 && ldt_info.seg_not_present == 1 &&
    473 	    ldt_info.useable == 0))) {
    474 		/* this means you should zero the ldt */
    475 		(void)memset(&sd, 0, sizeof(sd));
    476 	} else {
    477 		sd.sd_lobase = ldt_info.base_addr & 0xffffff;
    478 		sd.sd_hibase = (ldt_info.base_addr >> 24) & 0xff;
    479 		sd.sd_lolimit = ldt_info.limit & 0xffff;
    480 		sd.sd_hilimit = (ldt_info.limit >> 16) & 0xf;
    481 		sd.sd_type = 16 | (ldt_info.contents << 2) |
    482 		    (!ldt_info.read_exec_only << 1);
    483 		sd.sd_dpl = SEL_UPL;
    484 		sd.sd_p = !ldt_info.seg_not_present;
    485 		sd.sd_def32 = ldt_info.seg_32bit;
    486 		sd.sd_gran = ldt_info.limit_in_pages;
    487 		if (!oldmode)
    488 			sd.sd_xx = ldt_info.useable;
    489 		else
    490 			sd.sd_xx = 0;
    491 	}
    492 	sg = stackgap_init(p, 0);
    493 	sl.start = ldt_info.entry_number;
    494 	sl.desc = stackgap_alloc(p, &sg, sizeof(sd));
    495 	sl.num = 1;
    496 
    497 	DPRINTF(("linux_write_ldt: idx=%d, base=0x%lx, limit=0x%x\n",
    498 	    ldt_info.entry_number, ldt_info.base_addr, ldt_info.limit));
    499 
    500 	parms = stackgap_alloc(p, &sg, sizeof(sl));
    501 
    502 	if ((error = copyout(&sd, sl.desc, sizeof(sd))) != 0)
    503 		return (error);
    504 	if ((error = copyout(&sl, parms, sizeof(sl))) != 0)
    505 		return (error);
    506 
    507 	if ((error = i386_set_ldt(l, parms, retval)) != 0)
    508 		return (error);
    509 
    510 	*retval = 0;
    511 	return (0);
    512 }
    513 
    514 #endif /* USER_LDT */
    515 
    516 int
    517 linux_sys_modify_ldt(l, v, retval)
    518 	struct lwp *l;
    519 	void *v;
    520 	register_t *retval;
    521 {
    522 	struct linux_sys_modify_ldt_args /* {
    523 		syscallarg(int) func;
    524 		syscallarg(void *) ptr;
    525 		syscallarg(size_t) bytecount;
    526 	} */ *uap = v;
    527 
    528 	switch (SCARG(uap, func)) {
    529 #ifdef USER_LDT
    530 	case 0:
    531 		return linux_read_ldt(l, uap, retval);
    532 	case 1:
    533 		retval[0] = 1;
    534 		return linux_write_ldt(l, uap, retval);
    535 	case 2:
    536 #ifdef notyet
    537 		return (linux_read_default_ldt(l, uap, retval);
    538 #else
    539 		return (ENOSYS);
    540 #endif
    541 	case 0x11:
    542 		retval[0] = 0;
    543 		return linux_write_ldt(l, uap, retval);
    544 #endif /* USER_LDT */
    545 
    546 	default:
    547 		return (ENOSYS);
    548 	}
    549 }
    550 
    551 /*
    552  * XXX Pathetic hack to make svgalib work. This will fake the major
    553  * device number of an opened VT so that svgalib likes it. grmbl.
    554  * Should probably do it 'wrong the right way' and use a mapping
    555  * array for all major device numbers, and map linux_mknod too.
    556  */
    557 dev_t
    558 linux_fakedev(dev, raw)
    559 	dev_t dev;
    560 	int raw;
    561 {
    562 	if (raw) {
    563 #if (NWSDISPLAY > 0)
    564 		if (major(dev) == NETBSD_WSCONS_MAJOR)
    565 			return makedev(LINUX_CONS_MAJOR, (minor(dev) + 1));
    566 #endif
    567 		return 0;
    568 	} else {
    569 		return dev;
    570 	}
    571 }
    572 
    573 #if (NWSDISPLAY > 0)
    574 /*
    575  * That's not complete, but enough to get an X server running.
    576  */
    577 #define NR_KEYS 128
    578 static const u_short plain_map[NR_KEYS] = {
    579 	0x0200,	0x001b,	0x0031,	0x0032,	0x0033,	0x0034,	0x0035,	0x0036,
    580 	0x0037,	0x0038,	0x0039,	0x0030,	0x002d,	0x003d,	0x007f,	0x0009,
    581 	0x0b71,	0x0b77,	0x0b65,	0x0b72,	0x0b74,	0x0b79,	0x0b75,	0x0b69,
    582 	0x0b6f,	0x0b70,	0x005b,	0x005d,	0x0201,	0x0702,	0x0b61,	0x0b73,
    583 	0x0b64,	0x0b66,	0x0b67,	0x0b68,	0x0b6a,	0x0b6b,	0x0b6c,	0x003b,
    584 	0x0027,	0x0060,	0x0700,	0x005c,	0x0b7a,	0x0b78,	0x0b63,	0x0b76,
    585 	0x0b62,	0x0b6e,	0x0b6d,	0x002c,	0x002e,	0x002f,	0x0700,	0x030c,
    586 	0x0703,	0x0020,	0x0207,	0x0100,	0x0101,	0x0102,	0x0103,	0x0104,
    587 	0x0105,	0x0106,	0x0107,	0x0108,	0x0109,	0x0208,	0x0209,	0x0307,
    588 	0x0308,	0x0309,	0x030b,	0x0304,	0x0305,	0x0306,	0x030a,	0x0301,
    589 	0x0302,	0x0303,	0x0300,	0x0310,	0x0206,	0x0200,	0x003c,	0x010a,
    590 	0x010b,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,
    591 	0x030e,	0x0702,	0x030d,	0x001c,	0x0701,	0x0205,	0x0114,	0x0603,
    592 	0x0118,	0x0601,	0x0602,	0x0117,	0x0600,	0x0119,	0x0115,	0x0116,
    593 	0x011a,	0x010c,	0x010d,	0x011b,	0x011c,	0x0110,	0x0311,	0x011d,
    594 	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,
    595 }, shift_map[NR_KEYS] = {
    596 	0x0200,	0x001b,	0x0021,	0x0040,	0x0023,	0x0024,	0x0025,	0x005e,
    597 	0x0026,	0x002a,	0x0028,	0x0029,	0x005f,	0x002b,	0x007f,	0x0009,
    598 	0x0b51,	0x0b57,	0x0b45,	0x0b52,	0x0b54,	0x0b59,	0x0b55,	0x0b49,
    599 	0x0b4f,	0x0b50,	0x007b,	0x007d,	0x0201,	0x0702,	0x0b41,	0x0b53,
    600 	0x0b44,	0x0b46,	0x0b47,	0x0b48,	0x0b4a,	0x0b4b,	0x0b4c,	0x003a,
    601 	0x0022,	0x007e,	0x0700,	0x007c,	0x0b5a,	0x0b58,	0x0b43,	0x0b56,
    602 	0x0b42,	0x0b4e,	0x0b4d,	0x003c,	0x003e,	0x003f,	0x0700,	0x030c,
    603 	0x0703,	0x0020,	0x0207,	0x010a,	0x010b,	0x010c,	0x010d,	0x010e,
    604 	0x010f,	0x0110,	0x0111,	0x0112,	0x0113,	0x0213,	0x0203,	0x0307,
    605 	0x0308,	0x0309,	0x030b,	0x0304,	0x0305,	0x0306,	0x030a,	0x0301,
    606 	0x0302,	0x0303,	0x0300,	0x0310,	0x0206,	0x0200,	0x003e,	0x010a,
    607 	0x010b,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,
    608 	0x030e,	0x0702,	0x030d,	0x0200,	0x0701,	0x0205,	0x0114,	0x0603,
    609 	0x020b,	0x0601,	0x0602,	0x0117,	0x0600,	0x020a,	0x0115,	0x0116,
    610 	0x011a,	0x010c,	0x010d,	0x011b,	0x011c,	0x0110,	0x0311,	0x011d,
    611 	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,
    612 }, altgr_map[NR_KEYS] = {
    613 	0x0200,	0x0200,	0x0200,	0x0040,	0x0200,	0x0024,	0x0200,	0x0200,
    614 	0x007b,	0x005b,	0x005d,	0x007d,	0x005c,	0x0200,	0x0200,	0x0200,
    615 	0x0b71,	0x0b77,	0x0918,	0x0b72,	0x0b74,	0x0b79,	0x0b75,	0x0b69,
    616 	0x0b6f,	0x0b70,	0x0200,	0x007e,	0x0201,	0x0702,	0x0914,	0x0b73,
    617 	0x0917,	0x0919,	0x0b67,	0x0b68,	0x0b6a,	0x0b6b,	0x0b6c,	0x0200,
    618 	0x0200,	0x0200,	0x0700,	0x0200,	0x0b7a,	0x0b78,	0x0916,	0x0b76,
    619 	0x0915,	0x0b6e,	0x0b6d,	0x0200,	0x0200,	0x0200,	0x0700,	0x030c,
    620 	0x0703,	0x0200,	0x0207,	0x050c,	0x050d,	0x050e,	0x050f,	0x0510,
    621 	0x0511,	0x0512,	0x0513,	0x0514,	0x0515,	0x0208,	0x0202,	0x0911,
    622 	0x0912,	0x0913,	0x030b,	0x090e,	0x090f,	0x0910,	0x030a,	0x090b,
    623 	0x090c,	0x090d,	0x090a,	0x0310,	0x0206,	0x0200,	0x007c,	0x0516,
    624 	0x0517,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,
    625 	0x030e,	0x0702,	0x030d,	0x0200,	0x0701,	0x0205,	0x0114,	0x0603,
    626 	0x0118,	0x0601,	0x0602,	0x0117,	0x0600,	0x0119,	0x0115,	0x0116,
    627 	0x011a,	0x010c,	0x010d,	0x011b,	0x011c,	0x0110,	0x0311,	0x011d,
    628 	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,
    629 }, ctrl_map[NR_KEYS] = {
    630 	0x0200,	0x0200,	0x0200,	0x0000,	0x001b,	0x001c,	0x001d,	0x001e,
    631 	0x001f,	0x007f,	0x0200,	0x0200,	0x001f,	0x0200,	0x0008,	0x0200,
    632 	0x0011,	0x0017,	0x0005,	0x0012,	0x0014,	0x0019,	0x0015,	0x0009,
    633 	0x000f,	0x0010,	0x001b,	0x001d,	0x0201,	0x0702,	0x0001,	0x0013,
    634 	0x0004,	0x0006,	0x0007,	0x0008,	0x000a,	0x000b,	0x000c,	0x0200,
    635 	0x0007,	0x0000,	0x0700,	0x001c,	0x001a,	0x0018,	0x0003,	0x0016,
    636 	0x0002,	0x000e,	0x000d,	0x0200,	0x020e,	0x007f,	0x0700,	0x030c,
    637 	0x0703,	0x0000,	0x0207,	0x0100,	0x0101,	0x0102,	0x0103,	0x0104,
    638 	0x0105,	0x0106,	0x0107,	0x0108,	0x0109,	0x0208,	0x0204,	0x0307,
    639 	0x0308,	0x0309,	0x030b,	0x0304,	0x0305,	0x0306,	0x030a,	0x0301,
    640 	0x0302,	0x0303,	0x0300,	0x0310,	0x0206,	0x0200,	0x0200,	0x010a,
    641 	0x010b,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,
    642 	0x030e,	0x0702,	0x030d,	0x001c,	0x0701,	0x0205,	0x0114,	0x0603,
    643 	0x0118,	0x0601,	0x0602,	0x0117,	0x0600,	0x0119,	0x0115,	0x0116,
    644 	0x011a,	0x010c,	0x010d,	0x011b,	0x011c,	0x0110,	0x0311,	0x011d,
    645 	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,	0x0200,
    646 };
    647 
    648 const u_short * const linux_keytabs[] = {
    649 	plain_map, shift_map, altgr_map, altgr_map, ctrl_map
    650 };
    651 #endif
    652 
    653 static struct biosdisk_info *
    654 fd2biosinfo(p, fp)
    655 	struct proc *p;
    656 	struct file *fp;
    657 {
    658 	struct vnode *vp;
    659 	const char *blkname;
    660 	char diskname[16];
    661 	int i;
    662 	struct nativedisk_info *nip;
    663 	struct disklist *dl = i386_alldisks;
    664 
    665 	if (fp->f_type != DTYPE_VNODE)
    666 		return NULL;
    667 	vp = (struct vnode *)fp->f_data;
    668 
    669 	if (vp->v_type != VBLK)
    670 		return NULL;
    671 
    672 	blkname = findblkname(major(vp->v_rdev));
    673 	snprintf(diskname, sizeof diskname, "%s%u", blkname,
    674 	    DISKUNIT(vp->v_rdev));
    675 
    676 	for (i = 0; i < dl->dl_nnativedisks; i++) {
    677 		nip = &dl->dl_nativedisks[i];
    678 		if (strcmp(diskname, nip->ni_devname))
    679 			continue;
    680 		if (nip->ni_nmatches != 0)
    681 			return &dl->dl_biosdisks[nip->ni_biosmatches[0]];
    682 	}
    683 
    684 	return NULL;
    685 }
    686 
    687 
    688 /*
    689  * We come here in a last attempt to satisfy a Linux ioctl() call
    690  */
    691 int
    692 linux_machdepioctl(p, v, retval)
    693 	struct proc *p;
    694 	void *v;
    695 	register_t *retval;
    696 {
    697 	struct linux_sys_ioctl_args /* {
    698 		syscallarg(int) fd;
    699 		syscallarg(u_long) com;
    700 		syscallarg(caddr_t) data;
    701 	} */ *uap = v;
    702 	struct sys_ioctl_args bia;
    703 	u_long com;
    704 	int error, error1;
    705 #if (NWSDISPLAY > 0)
    706 	struct vt_mode lvt;
    707 	caddr_t bvtp, sg;
    708 	struct kbentry kbe;
    709 #endif
    710 	struct linux_hd_geometry hdg;
    711 	struct linux_hd_big_geometry hdg_big;
    712 	struct biosdisk_info *bip;
    713 	struct filedesc *fdp;
    714 	struct file *fp;
    715 	int fd;
    716 	struct disklabel label, *labp;
    717 	struct partinfo partp;
    718 	int (*ioctlf) __P((struct file *, u_long, caddr_t, struct proc *));
    719 	u_long start, biostotal, realtotal;
    720 	u_char heads, sectors;
    721 	u_int cylinders;
    722 	struct ioctl_pt pt;
    723 
    724 	fd = SCARG(uap, fd);
    725 	SCARG(&bia, fd) = fd;
    726 	SCARG(&bia, data) = SCARG(uap, data);
    727 	com = SCARG(uap, com);
    728 
    729 	fdp = p->p_fd;
    730 
    731 	if ((fp = fd_getfile(fdp, fd)) == NULL)
    732 		return (EBADF);
    733 
    734 	switch (com) {
    735 #if (NWSDISPLAY > 0)
    736 	case LINUX_KDGKBMODE:
    737 		com = KDGKBMODE;
    738 		break;
    739 	case LINUX_KDSKBMODE:
    740 		com = KDSKBMODE;
    741 		if ((unsigned)SCARG(uap, data) == LINUX_K_MEDIUMRAW)
    742 			SCARG(&bia, data) = (caddr_t)K_RAW;
    743 		break;
    744 	case LINUX_KIOCSOUND:
    745 		SCARG(&bia, data) =
    746 		    (caddr_t)(((unsigned long)SCARG(&bia, data)) & 0xffff);
    747 		/* fall through */
    748 	case LINUX_KDMKTONE:
    749 		com = KDMKTONE;
    750 		break;
    751 	case LINUX_KDSETMODE:
    752 		com = KDSETMODE;
    753 		break;
    754 	case LINUX_KDGETMODE:
    755 		/* KD_* values are equal to the wscons numbers */
    756 		com = WSDISPLAYIO_GMODE;
    757 		break;
    758 	case LINUX_KDENABIO:
    759 		com = KDENABIO;
    760 		break;
    761 	case LINUX_KDDISABIO:
    762 		com = KDDISABIO;
    763 		break;
    764 	case LINUX_KDGETLED:
    765 		com = KDGETLED;
    766 		break;
    767 	case LINUX_KDSETLED:
    768 		com = KDSETLED;
    769 		break;
    770 	case LINUX_VT_OPENQRY:
    771 		com = VT_OPENQRY;
    772 		break;
    773 	case LINUX_VT_GETMODE:
    774 		SCARG(&bia, com) = VT_GETMODE;
    775 		/* XXX NJWLWP */
    776 		if ((error = sys_ioctl(curproc, &bia, retval)))
    777 			return error;
    778 		if ((error = copyin(SCARG(uap, data), (caddr_t)&lvt,
    779 		    sizeof (struct vt_mode))))
    780 			return error;
    781 		lvt.relsig = native_to_linux_signo[lvt.relsig];
    782 		lvt.acqsig = native_to_linux_signo[lvt.acqsig];
    783 		lvt.frsig = native_to_linux_signo[lvt.frsig];
    784 		return copyout((caddr_t)&lvt, SCARG(uap, data),
    785 		    sizeof (struct vt_mode));
    786 	case LINUX_VT_SETMODE:
    787 		com = VT_SETMODE;
    788 		if ((error = copyin(SCARG(uap, data), (caddr_t)&lvt,
    789 		    sizeof (struct vt_mode))))
    790 			return error;
    791 		lvt.relsig = linux_to_native_signo[lvt.relsig];
    792 		lvt.acqsig = linux_to_native_signo[lvt.acqsig];
    793 		lvt.frsig = linux_to_native_signo[lvt.frsig];
    794 		sg = stackgap_init(p, 0);
    795 		bvtp = stackgap_alloc(p, &sg, sizeof (struct vt_mode));
    796 		if ((error = copyout(&lvt, bvtp, sizeof (struct vt_mode))))
    797 			return error;
    798 		SCARG(&bia, data) = bvtp;
    799 		break;
    800 	case LINUX_VT_DISALLOCATE:
    801 		/* XXX should use WSDISPLAYIO_DELSCREEN */
    802 		return 0;
    803 	case LINUX_VT_RELDISP:
    804 		com = VT_RELDISP;
    805 		break;
    806 	case LINUX_VT_ACTIVATE:
    807 		com = VT_ACTIVATE;
    808 		break;
    809 	case LINUX_VT_WAITACTIVE:
    810 		com = VT_WAITACTIVE;
    811 		break;
    812 	case LINUX_VT_GETSTATE:
    813 		com = VT_GETSTATE;
    814 		break;
    815 	case LINUX_KDGKBTYPE:
    816 		/* This is what Linux does. */
    817 		return (subyte(SCARG(uap, data), KB_101));
    818 	case LINUX_KDGKBENT:
    819 		/*
    820 		 * The Linux KDGKBENT ioctl is different from the
    821 		 * SYSV original. So we handle it in machdep code.
    822 		 * XXX We should use keyboard mapping information
    823 		 * from wsdisplay, but this would be expensive.
    824 		 */
    825 		if ((error = copyin(SCARG(uap, data), &kbe,
    826 				    sizeof(struct kbentry))))
    827 			return (error);
    828 		if (kbe.kb_table >= sizeof(linux_keytabs) / sizeof(u_short *)
    829 		    || kbe.kb_index >= NR_KEYS)
    830 			return (EINVAL);
    831 		kbe.kb_value = linux_keytabs[kbe.kb_table][kbe.kb_index];
    832 		return (copyout(&kbe, SCARG(uap, data),
    833 				sizeof(struct kbentry)));
    834 #endif
    835 	case LINUX_HDIO_GETGEO:
    836 	case LINUX_HDIO_GETGEO_BIG:
    837 		/*
    838 		 * Try to mimic Linux behaviour: return the BIOS geometry
    839 		 * if possible (extending its # of cylinders if it's beyond
    840 		 * the 1023 limit), fall back to the MI geometry (i.e.
    841 		 * the real geometry) if not found, by returning an
    842 		 * error. See common/linux_hdio.c
    843 		 */
    844 		FILE_USE(fp);
    845 		bip = fd2biosinfo(p, fp);
    846 		ioctlf = fp->f_ops->fo_ioctl;
    847 		error = ioctlf(fp, DIOCGDEFLABEL, (caddr_t)&label, p);
    848 		error1 = ioctlf(fp, DIOCGPART, (caddr_t)&partp, p);
    849 		FILE_UNUSE(fp, p);
    850 		if (error != 0 && error1 != 0)
    851 			return error1;
    852 		labp = error != 0 ? &label : partp.disklab;
    853 		start = error1 != 0 ? partp.part->p_offset : 0;
    854 		if (bip != NULL && bip->bi_head != 0 && bip->bi_sec != 0
    855 		    && bip->bi_cyl != 0) {
    856 			heads = bip->bi_head;
    857 			sectors = bip->bi_sec;
    858 			cylinders = bip->bi_cyl;
    859 			biostotal = heads * sectors * cylinders;
    860 			realtotal = labp->d_ntracks * labp->d_nsectors *
    861 			    labp->d_ncylinders;
    862 			if (realtotal > biostotal)
    863 				cylinders = realtotal / (heads * sectors);
    864 		} else {
    865 			heads = labp->d_ntracks;
    866 			cylinders = labp->d_ncylinders;
    867 			sectors = labp->d_nsectors;
    868 		}
    869 		if (com == LINUX_HDIO_GETGEO) {
    870 			hdg.start = start;
    871 			hdg.heads = heads;
    872 			hdg.cylinders = cylinders;
    873 			hdg.sectors = sectors;
    874 			return copyout(&hdg, SCARG(uap, data), sizeof hdg);
    875 		} else {
    876 			hdg_big.start = start;
    877 			hdg_big.heads = heads;
    878 			hdg_big.cylinders = cylinders;
    879 			hdg_big.sectors = sectors;
    880 			return copyout(&hdg_big, SCARG(uap, data),
    881 			    sizeof hdg_big);
    882 		}
    883 		return 0;
    884 
    885 	default:
    886 		/*
    887 		 * Unknown to us. If it's on a device, just pass it through
    888 		 * using PTIOCLINUX, the device itself might be able to
    889 		 * make some sense of it.
    890 		 * XXX hack: if the function returns EJUSTRETURN,
    891 		 * it has stuffed a sysctl return value in pt.data.
    892 		 */
    893 		FILE_USE(fp);
    894 		ioctlf = fp->f_ops->fo_ioctl;
    895 		pt.com = SCARG(uap, com);
    896 		pt.data = SCARG(uap, data);
    897 		error = ioctlf(fp, PTIOCLINUX, (caddr_t)&pt, p);
    898 		FILE_UNUSE(fp, p);
    899 		if (error == EJUSTRETURN) {
    900 			retval[0] = (register_t)pt.data;
    901 			error = 0;
    902 		}
    903 
    904 		if (error == ENOTTY)
    905 			DPRINTF(("linux_machdepioctl: invalid ioctl %08lx\n",
    906 			    com));
    907 		return error;
    908 	}
    909 	SCARG(&bia, com) = com;
    910 	/* XXX NJWLWP */
    911 	return sys_ioctl(curproc, &bia, retval);
    912 }
    913 
    914 /*
    915  * Set I/O permissions for a process. Just set the maximum level
    916  * right away (ignoring the argument), otherwise we would have
    917  * to rely on I/O permission maps, which are not implemented.
    918  */
    919 int
    920 linux_sys_iopl(l, v, retval)
    921 	struct lwp *l;
    922 	void *v;
    923 	register_t *retval;
    924 {
    925 #if 0
    926 	struct linux_sys_iopl_args /* {
    927 		syscallarg(int) level;
    928 	} */ *uap = v;
    929 #endif
    930 	struct proc *p = l->l_proc;
    931 	struct trapframe *fp = l->l_md.md_regs;
    932 
    933 	if (suser(p->p_ucred, &p->p_acflag) != 0)
    934 		return EPERM;
    935 	fp->tf_eflags |= PSL_IOPL;
    936 	*retval = 0;
    937 	return 0;
    938 }
    939 
    940 /*
    941  * See above. If a root process tries to set access to an I/O port,
    942  * just let it have the whole range.
    943  */
    944 int
    945 linux_sys_ioperm(l, v, retval)
    946 	struct lwp *l;
    947 	void *v;
    948 	register_t *retval;
    949 {
    950 	struct linux_sys_ioperm_args /* {
    951 		syscallarg(unsigned int) lo;
    952 		syscallarg(unsigned int) hi;
    953 		syscallarg(int) val;
    954 	} */ *uap = v;
    955 	struct proc *p = l->l_proc;
    956 	struct trapframe *fp = l->l_md.md_regs;
    957 
    958 	if (suser(p->p_ucred, &p->p_acflag) != 0)
    959 		return EPERM;
    960 	if (SCARG(uap, val))
    961 		fp->tf_eflags |= PSL_IOPL;
    962 	*retval = 0;
    963 	return 0;
    964 }
    965