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