Bring in the remainder of the post-SoC amd64 enchilada.
[dragonfly.git] / sys / platform / pc64 / amd64 / trap.c
1 /*-
2  * Copyright (c) 1990, 1993
3  *      The Regents of the University of California.  All rights reserved.
4  * Copyright (C) 1994, David Greenman
5  * Copyright (c) 2008 The DragonFly Project.
6  * Copyright (c) 2008 Jordan Gordeev.
7  *
8  * This code is derived from software contributed to Berkeley by
9  * the University of Utah, and William Jolitz.
10  *
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 1. Redistributions of source code must retain the above copyright
15  *    notice, this list of conditions and the following disclaimer.
16  * 2. Redistributions in binary form must reproduce the above copyright
17  *    notice, this list of conditions and the following disclaimer in the
18  *    documentation and/or other materials provided with the distribution.
19  * 3. All advertising materials mentioning features or use of this software
20  *    must display the following acknowledgement:
21  *      This product includes software developed by the University of
22  *      California, Berkeley and its contributors.
23  * 4. Neither the name of the University nor the names of its contributors
24  *    may be used to endorse or promote products derived from this software
25  *    without specific prior written permission.
26  *
27  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
28  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
29  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
30  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
31  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
32  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
33  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
34  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
35  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
36  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
37  * SUCH DAMAGE.
38  *
39  * from: @(#)trap.c     7.4 (Berkeley) 5/13/91
40  * $FreeBSD: src/sys/i386/i386/trap.c,v 1.147.2.11 2003/02/27 19:09:59 luoqi Exp $
41  * $DragonFly: src/sys/platform/pc64/amd64/trap.c,v 1.3 2008/09/09 04:06:18 dillon Exp $
42  */
43
44 /*
45  * AMD64 Trap and System call handling
46  */
47
48 #include "opt_ddb.h"
49 #include "opt_ktrace.h"
50
51 #include <machine/frame.h>
52 #include <sys/param.h>
53 #include <sys/systm.h>
54 #include <sys/kernel.h>
55 #include <sys/proc.h>
56 #include <sys/pioctl.h>
57 #include <sys/types.h>
58 #include <sys/signal2.h>
59 #include <sys/syscall.h>
60 #include <sys/sysctl.h>
61 #include <sys/sysent.h>
62 #include <sys/systm.h>
63 #ifdef KTRACE
64 #include <sys/ktrace.h>
65 #endif
66 #include <sys/ktr.h>
67 #include <sys/sysmsg.h>
68 #include <sys/sysproto.h>
69 #include <sys/sysunion.h>
70
71 #include <vm/pmap.h>
72 #include <vm/vm.h>
73 #include <vm/vm_extern.h>
74 #include <vm/vm_kern.h>
75 #include <vm/vm_param.h>
76 #include <machine/cpu.h>
77 #include <machine/pcb.h>
78 #include <machine/thread.h>
79 #include <machine/vmparam.h>
80 #include <machine/md_var.h>
81
82 #include <ddb/ddb.h>
83
84 #ifdef SMP
85
86 #define MAKEMPSAFE(have_mplock)                 \
87         if (have_mplock == 0) {                 \
88                 get_mplock();                   \
89                 have_mplock = 1;                \
90         }
91
92 #else
93
94 #define MAKEMPSAFE(have_mplock)
95
96 #endif
97
98 extern void trap(struct trapframe *frame);
99 extern void syscall2(struct trapframe *frame);
100
101 static int trap_pfault(struct trapframe *, int);
102 static void trap_fatal(struct trapframe *, vm_offset_t);
103 void dblfault_handler(struct trapframe *frame);
104
105 #define PCPU_GET(member) ((mycpu)->gd_##member)
106 #define PCPU_INC(member) ((mycpu)->gd_##member)++
107
108 #define MAX_TRAP_MSG            30
109 static char *trap_msg[] = {
110         "",                                     /*  0 unused */
111         "privileged instruction fault",         /*  1 T_PRIVINFLT */
112         "",                                     /*  2 unused */
113         "breakpoint instruction fault",         /*  3 T_BPTFLT */
114         "",                                     /*  4 unused */
115         "",                                     /*  5 unused */
116         "arithmetic trap",                      /*  6 T_ARITHTRAP */
117         "system forced exception",              /*  7 T_ASTFLT */
118         "",                                     /*  8 unused */
119         "general protection fault",             /*  9 T_PROTFLT */
120         "trace trap",                           /* 10 T_TRCTRAP */
121         "",                                     /* 11 unused */
122         "page fault",                           /* 12 T_PAGEFLT */
123         "",                                     /* 13 unused */
124         "alignment fault",                      /* 14 T_ALIGNFLT */
125         "",                                     /* 15 unused */
126         "",                                     /* 16 unused */
127         "",                                     /* 17 unused */
128         "integer divide fault",                 /* 18 T_DIVIDE */
129         "non-maskable interrupt trap",          /* 19 T_NMI */
130         "overflow trap",                        /* 20 T_OFLOW */
131         "FPU bounds check fault",               /* 21 T_BOUND */
132         "FPU device not available",             /* 22 T_DNA */
133         "double fault",                         /* 23 T_DOUBLEFLT */
134         "FPU operand fetch fault",              /* 24 T_FPOPFLT */
135         "invalid TSS fault",                    /* 25 T_TSSFLT */
136         "segment not present fault",            /* 26 T_SEGNPFLT */
137         "stack fault",                          /* 27 T_STKFLT */
138         "machine check trap",                   /* 28 T_MCHK */
139         "SIMD floating-point exception",        /* 29 T_XMMFLT */
140         "reserved (unknown) fault",             /* 30 T_RESERVED */
141 };
142
143 #ifdef DDB
144 static int ddb_on_nmi = 1;
145 SYSCTL_INT(_machdep, OID_AUTO, ddb_on_nmi, CTLFLAG_RW,
146         &ddb_on_nmi, 0, "Go to DDB on NMI");
147 #endif
148 static int panic_on_nmi = 1;
149 SYSCTL_INT(_machdep, OID_AUTO, panic_on_nmi, CTLFLAG_RW,
150         &panic_on_nmi, 0, "Panic on NMI");
151 static int fast_release;
152 SYSCTL_INT(_machdep, OID_AUTO, fast_release, CTLFLAG_RW,
153         &fast_release, 0, "Passive Release was optimal");
154 static int slow_release;
155 SYSCTL_INT(_machdep, OID_AUTO, slow_release, CTLFLAG_RW,
156         &slow_release, 0, "Passive Release was nonoptimal");
157 #ifdef SMP
158 static int syscall_mpsafe = 1;
159 SYSCTL_INT(_kern, OID_AUTO, syscall_mpsafe, CTLFLAG_RW,
160         &syscall_mpsafe, 0, "Allow MPSAFE marked syscalls to run without BGL");
161 TUNABLE_INT("kern.syscall_mpsafe", &syscall_mpsafe);
162 static int trap_mpsafe = 1;
163 SYSCTL_INT(_kern, OID_AUTO, trap_mpsafe, CTLFLAG_RW,
164         &trap_mpsafe, 0, "Allow traps to mostly run without the BGL");
165 TUNABLE_INT("kern.trap_mpsafe", &trap_mpsafe);
166 #endif
167
168
169
170 /*
171  * Passive USER->KERNEL transition.  This only occurs if we block in the
172  * kernel while still holding our userland priority.  We have to fixup our
173  * priority in order to avoid potential deadlocks before we allow the system
174  * to switch us to another thread.
175  */
176 static void
177 passive_release(struct thread *td)
178 {
179         struct lwp *lp = td->td_lwp;
180
181         td->td_release = NULL;
182         lwkt_setpri_self(TDPRI_KERN_USER);
183         lp->lwp_proc->p_usched->release_curproc(lp);
184 }
185
186 /*
187  * userenter() passively intercepts the thread switch function to increase
188  * the thread priority from a user priority to a kernel priority, reducing
189  * syscall and trap overhead for the case where no switch occurs.
190  */
191
192 static __inline void
193 userenter(struct thread *curtd)
194 {
195         curtd->td_release = passive_release;
196 }
197
198 /*
199  * Handle signals, upcalls, profiling, and other AST's and/or tasks that
200  * must be completed before we can return to or try to return to userland.
201  *
202  * Note that td_sticks is a 64 bit quantity, but there's no point doing 64
203  * arithmatic on the delta calculation so the absolute tick values are
204  * truncated to an integer.
205  */
206 static void
207 userret(struct lwp *lp, struct trapframe *frame, int sticks)
208 {
209         struct proc *p = lp->lwp_proc;
210         int sig;
211
212         /*
213          * Charge system time if profiling.  Note: times are in microseconds.
214          * This may do a copyout and block, so do it first even though it
215          * means some system time will be charged as user time.
216          */
217         if (p->p_flag & P_PROFIL) {
218                 addupc_task(p, frame->tf_rip, 
219                         (u_int)((int)lp->lwp_thread->td_sticks - sticks));
220         }
221
222 recheck:
223         /*
224          * If the jungle wants us dead, so be it.
225          */
226         if (lp->lwp_flag & LWP_WEXIT) {
227                 get_mplock();
228                 lwp_exit(0);
229                 rel_mplock(); /* NOT REACHED */
230         }
231
232         /*
233          * Block here if we are in a stopped state.
234          */
235         if (p->p_stat == SSTOP) {
236                 get_mplock();
237                 tstop();
238                 rel_mplock();
239                 goto recheck;
240         }
241
242         /*
243          * Post any pending upcalls.  If running a virtual kernel be sure
244          * to restore the virtual kernel's vmspace before posting the upcall.
245          */
246         if (p->p_flag & P_UPCALLPEND) {
247                 p->p_flag &= ~P_UPCALLPEND;
248                 get_mplock();
249                 postupcall(lp);
250                 rel_mplock();
251                 goto recheck;
252         }
253
254         /*
255          * Post any pending signals.  If running a virtual kernel be sure
256          * to restore the virtual kernel's vmspace before posting the signal.
257          */
258         if ((sig = CURSIG(lp)) != 0) {
259                 get_mplock();
260                 postsig(sig);
261                 rel_mplock();
262                 goto recheck;
263         }
264
265         /*
266          * block here if we are swapped out, but still process signals
267          * (such as SIGKILL).  proc0 (the swapin scheduler) is already
268          * aware of our situation, we do not have to wake it up.
269          */
270         if (p->p_flag & P_SWAPPEDOUT) {
271                 get_mplock();
272                 p->p_flag |= P_SWAPWAIT;
273                 swapin_request();
274                 if (p->p_flag & P_SWAPWAIT)
275                         tsleep(p, PCATCH, "SWOUT", 0);
276                 p->p_flag &= ~P_SWAPWAIT;
277                 rel_mplock();
278                 goto recheck;
279         }
280
281         /*
282          * Make sure postsig() handled request to restore old signal mask after
283          * running signal handler.
284          */
285         KKASSERT((lp->lwp_flag & LWP_OLDMASK) == 0);
286 }
287
288 /*
289  * Cleanup from userenter and any passive release that might have occured.
290  * We must reclaim the current-process designation before we can return
291  * to usermode.  We also handle both LWKT and USER reschedule requests.
292  */
293 static __inline void
294 userexit(struct lwp *lp)
295 {
296         struct thread *td = lp->lwp_thread;
297         globaldata_t gd = td->td_gd;
298
299 #if 0
300         /*
301          * If a user reschedule is requested force a new process to be
302          * chosen by releasing the current process.  Our process will only
303          * be chosen again if it has a considerably better priority.
304          */
305         if (user_resched_wanted())
306                 lp->lwp_proc->p_usched->release_curproc(lp);
307 #endif
308
309         /*
310          * Handle a LWKT reschedule request first.  Since our passive release
311          * is still in place we do not have to do anything special.
312          */
313         while (lwkt_resched_wanted()) {
314                 lwkt_switch();
315
316                 /*
317                  * The thread that preempted us may have stopped our process.
318                  */
319                 while (lp->lwp_proc->p_stat == SSTOP) {
320                         get_mplock();
321                         tstop();
322                         rel_mplock();
323                 }
324         }
325
326         /*
327          * Acquire the current process designation for this user scheduler
328          * on this cpu.  This will also handle any user-reschedule requests.
329          */
330         lp->lwp_proc->p_usched->acquire_curproc(lp);
331         /* We may have switched cpus on acquisition */
332         gd = td->td_gd;
333
334         /*
335          * Reduce our priority in preparation for a return to userland.  If
336          * our passive release function was still in place, our priority was
337          * never raised and does not need to be reduced.
338          *
339          * Note that at this point there may be other LWKT thread at
340          * TDPRI_KERN_USER (aka higher then our currenet priority).  We
341          * do NOT want to run these threads yet.
342          */
343         if (td->td_release == NULL)
344                 lwkt_setpri_self(TDPRI_USER_NORM);
345         td->td_release = NULL;
346 }
347
348 #if !defined(KTR_KERNENTRY)
349 #define KTR_KERNENTRY   KTR_ALL
350 #endif
351 KTR_INFO_MASTER(kernentry);
352 KTR_INFO(KTR_KERNENTRY, kernentry, trap, 0, "STR",
353          sizeof(long) + sizeof(long) + sizeof(long) + sizeof(vm_offset_t));
354 KTR_INFO(KTR_KERNENTRY, kernentry, trap_ret, 0, "STR",
355          sizeof(long) + sizeof(long));
356 KTR_INFO(KTR_KERNENTRY, kernentry, syscall, 0, "STR",
357          sizeof(long) + sizeof(long) + sizeof(long));
358 KTR_INFO(KTR_KERNENTRY, kernentry, syscall_ret, 0, "STR",
359          sizeof(long) + sizeof(long) + sizeof(long));
360 KTR_INFO(KTR_KERNENTRY, kernentry, fork_ret, 0, "STR",
361          sizeof(long) + sizeof(long));
362
363 /*
364  * Exception, fault, and trap interface to the kernel.
365  * This common code is called from assembly language IDT gate entry
366  * routines that prepare a suitable stack frame, and restore this
367  * frame after the exception has been processed.
368  *
369  * This function is also called from doreti in an interlock to handle ASTs.
370  * For example:  hardwareint->INTROUTINE->(set ast)->doreti->trap
371  *
372  * NOTE!  We have to retrieve the fault address prior to obtaining the
373  * MP lock because get_mplock() may switch out.  YYY cr2 really ought
374  * to be retrieved by the assembly code, not here.
375  *
376  * XXX gd_trap_nesting_level currently prevents lwkt_switch() from panicing
377  * if an attempt is made to switch from a fast interrupt or IPI.  This is
378  * necessary to properly take fatal kernel traps on SMP machines if 
379  * get_mplock() has to block.
380  */
381
382 void
383 trap(struct trapframe *frame)
384 {
385         struct globaldata *gd = mycpu;
386         struct thread *td = gd->gd_curthread;
387         struct lwp *lp = td->td_lwp;
388         struct proc *p;
389         int sticks = 0;
390         int i = 0, ucode = 0, type, code;
391 #ifdef SMP
392         int have_mplock = 0;
393 #endif
394 #ifdef INVARIANTS
395         int crit_count = td->td_pri & ~TDPRI_MASK;
396 #endif
397         vm_offset_t eva;
398
399         p = td->td_proc;
400
401 #ifndef JG
402         kprintf0("TRAP ");
403         kprintf0("\"%s\" type=%ld\n",
404                 trap_msg[frame->tf_trapno], frame->tf_trapno);
405         kprintf0(" rip=%lx rsp=%lx\n", frame->tf_rip, frame->tf_rsp);
406         kprintf0(" err=%lx addr=%lx\n", frame->tf_err, frame->tf_addr);
407         kprintf0(" cs=%lx ss=%lx rflags=%lx\n", (unsigned long)frame->tf_cs, (unsigned long)frame->tf_ss, frame->tf_rflags);
408 #endif
409
410 #ifdef DDB
411         if (db_active) {
412                 ++gd->gd_trap_nesting_level;
413                 MAKEMPSAFE(have_mplock);
414                 trap_fatal(frame, frame->tf_addr);
415                 --gd->gd_trap_nesting_level;
416                 goto out2;
417         }
418 #endif
419 #ifdef DDB
420         if (db_active) {
421                 eva = (frame->tf_trapno == T_PAGEFLT ? frame->tf_addr : 0);
422                 ++gd->gd_trap_nesting_level;
423                 MAKEMPSAFE(have_mplock);
424                 trap_fatal(frame, eva);
425                 --gd->gd_trap_nesting_level;
426                 goto out2;
427         }
428 #endif
429
430         eva = 0;
431
432 #ifdef SMP
433         if (trap_mpsafe == 0) {
434                 ++gd->gd_trap_nesting_level;
435                 MAKEMPSAFE(have_mplock);
436                 --gd->gd_trap_nesting_level;
437         }
438 #endif
439
440         if ((frame->tf_rflags & PSL_I) == 0) {
441                 /*
442                  * Buggy application or kernel code has disabled interrupts
443                  * and then trapped.  Enabling interrupts now is wrong, but
444                  * it is better than running with interrupts disabled until
445                  * they are accidentally enabled later.
446                  */
447                 type = frame->tf_trapno;
448                 if (ISPL(frame->tf_cs) == SEL_UPL) {
449                         MAKEMPSAFE(have_mplock);
450                         /* JG curproc can be NULL */
451                         kprintf(
452                             "pid %ld (%s): trap %d with interrupts disabled\n",
453                             (long)curproc->p_pid, curproc->p_comm, type);
454                 } else if (type != T_NMI && type != T_BPTFLT &&
455                     type != T_TRCTRAP) {
456                         /*
457                          * XXX not quite right, since this may be for a
458                          * multiple fault in user mode.
459                          */
460                         MAKEMPSAFE(have_mplock);
461                         kprintf("kernel trap %d with interrupts disabled\n",
462                             type);
463                 }
464                 cpu_enable_intr();
465         }
466
467         type = frame->tf_trapno;
468         code = frame->tf_err;
469
470         if (ISPL(frame->tf_cs) == SEL_UPL) {
471                 /* user trap */
472
473 #if JG
474                 KTR_LOG(kernentry_trap, p->p_pid, lp->lwp_tid,
475                         frame->tf_trapno, eva);
476 #else
477                 KTR_LOG_STR(kernentry_trap, "pid=%d, tid=%d, trapno=%ld, eva=%lx", p->p_pid, lp->lwp_tid,
478                         frame->tf_trapno, (frame->tf_trapno == T_PAGEFLT ? frame->tf_addr : 0));
479 #endif
480
481                 userenter(td);
482
483                 sticks = (int)td->td_sticks;
484                 lp->lwp_md.md_regs = frame;
485
486                 switch (type) {
487                 case T_PRIVINFLT:       /* privileged instruction fault */
488                         ucode = ILL_PRVOPC;
489                         i = SIGILL;
490                         break;
491
492                 case T_BPTFLT:          /* bpt instruction fault */
493                 case T_TRCTRAP:         /* trace trap */
494                         frame->tf_rflags &= ~PSL_T;
495                         i = SIGTRAP;
496                         break;
497
498                 case T_ARITHTRAP:       /* arithmetic trap */
499                         ucode = code;
500                         i = SIGFPE;
501 #if 0
502 #if JG
503                         ucode = fputrap();
504 #else
505                         ucode = code;
506 #endif
507                         i = SIGFPE;
508 #endif
509                         break;
510
511                 case T_ASTFLT:          /* Allow process switch */
512                         mycpu->gd_cnt.v_soft++;
513                         if (mycpu->gd_reqflags & RQF_AST_OWEUPC) {
514                                 atomic_clear_int_nonlocked(&mycpu->gd_reqflags,
515                                             RQF_AST_OWEUPC);
516                                 addupc_task(p, p->p_prof.pr_addr,
517                                             p->p_prof.pr_ticks);
518                         }
519                         goto out;
520
521                 case T_PROTFLT:         /* general protection fault */
522                 case T_SEGNPFLT:        /* segment not present fault */
523                 case T_TSSFLT:          /* invalid TSS fault */
524                 case T_DOUBLEFLT:       /* double fault */
525                 default:
526                         ucode = code + BUS_SEGM_FAULT ;
527                         i = SIGBUS;
528                         break;
529
530                 case T_PAGEFLT:         /* page fault */
531                         MAKEMPSAFE(have_mplock);
532                         i = trap_pfault(frame, TRUE);
533                         //kprintf("TRAP_PFAULT %d\n", i);
534                         if (frame->tf_rip == 0)
535                                 Debugger("debug");
536                         if (i == -1)
537                                 goto out;
538                         if (i == 0)
539                                 goto out;
540
541                         ucode = T_PAGEFLT;
542                         break;
543
544                 case T_DIVIDE:          /* integer divide fault */
545                         ucode = FPE_INTDIV;
546                         i = SIGFPE;
547                         break;
548
549                 case T_NMI:
550                         MAKEMPSAFE(have_mplock);
551                         /* machine/parity/power fail/"kitchen sink" faults */
552                         if (isa_nmi(code) == 0) {
553 #ifdef DDB
554                                 /*
555                                  * NMI can be hooked up to a pushbutton
556                                  * for debugging.
557                                  */
558                                 if (ddb_on_nmi) {
559                                         kprintf ("NMI ... going to debugger\n");
560                                         kdb_trap(type, 0, frame);
561                                 }
562 #endif /* DDB */
563                                 goto out2;
564                         } else if (panic_on_nmi)
565                                 panic("NMI indicates hardware failure");
566                         break;
567
568                 case T_OFLOW:           /* integer overflow fault */
569                         ucode = FPE_INTOVF;
570                         i = SIGFPE;
571                         break;
572
573                 case T_BOUND:           /* bounds check fault */
574                         ucode = FPE_FLTSUB;
575                         i = SIGFPE;
576                         break;
577
578                 case T_DNA:
579                         /*
580                          * Virtual kernel intercept - pass the DNA exception
581                          * to the virtual kernel if it asked to handle it.
582                          * This occurs when the virtual kernel is holding
583                          * onto the FP context for a different emulated
584                          * process then the one currently running.
585                          *
586                          * We must still call npxdna() since we may have
587                          * saved FP state that the virtual kernel needs
588                          * to hand over to a different emulated process.
589                          */
590                         if (lp->lwp_vkernel && lp->lwp_vkernel->ve &&
591                             (td->td_pcb->pcb_flags & FP_VIRTFP)
592                         ) {
593                                 npxdna();
594                                 break;
595                         }
596
597                         /*
598                          * The kernel may have switched out the FP unit's
599                          * state, causing the user process to take a fault
600                          * when it tries to use the FP unit.  Restore the
601                          * state here
602                          */
603                         if (npxdna())
604                                 goto out;
605                         i = SIGFPE;
606                         ucode = FPE_FPU_NP_TRAP;
607                         break;
608
609                 case T_FPOPFLT:         /* FPU operand fetch fault */
610                         ucode = T_FPOPFLT;
611                         i = SIGILL;
612                         break;
613
614                 case T_XMMFLT:          /* SIMD floating-point exception */
615                         ucode = 0; /* XXX */
616                         i = SIGFPE;
617                         break;
618                 }
619         } else {
620                 /* kernel trap */
621
622                 switch (type) {
623                 case T_PAGEFLT:                 /* page fault */
624                         MAKEMPSAFE(have_mplock);
625                         trap_pfault(frame, FALSE);
626                         goto out2;
627
628                 case T_DNA:
629                         /*
630                          * The kernel is apparently using fpu for copying.
631                          * XXX this should be fatal unless the kernel has
632                          * registered such use.
633                          */
634                         if (npxdna())
635                                 goto out2;
636                         break;
637
638                 case T_STKFLT:          /* stack fault */
639                         break;
640
641                 case T_PROTFLT:         /* general protection fault */
642                 case T_SEGNPFLT:        /* segment not present fault */
643                         /*
644                          * Invalid segment selectors and out of bounds
645                          * %rip's and %rsp's can be set up in user mode.
646                          * This causes a fault in kernel mode when the
647                          * kernel tries to return to user mode.  We want
648                          * to get this fault so that we can fix the
649                          * problem here and not have to check all the
650                          * selectors and pointers when the user changes
651                          * them.
652                          */
653                         kprintf0("trap.c line %d\n", __LINE__);
654                         if (mycpu->gd_intr_nesting_level == 0) {
655                                 if (td->td_pcb->pcb_onfault) {
656                                         frame->tf_rip = (register_t)
657                                                 td->td_pcb->pcb_onfault;
658                                         goto out2;
659                                 }
660                         }
661                         break;
662
663                 case T_TSSFLT:
664                         /*
665                          * PSL_NT can be set in user mode and isn't cleared
666                          * automatically when the kernel is entered.  This
667                          * causes a TSS fault when the kernel attempts to
668                          * `iret' because the TSS link is uninitialized.  We
669                          * want to get this fault so that we can fix the
670                          * problem here and not every time the kernel is
671                          * entered.
672                          */
673                         if (frame->tf_rflags & PSL_NT) {
674                                 frame->tf_rflags &= ~PSL_NT;
675                                 goto out2;
676                         }
677                         break;
678
679                 case T_TRCTRAP:  /* trace trap */
680 #if 0
681                         if (frame->tf_rip == (int)IDTVEC(syscall)) {
682                                 /*
683                                  * We've just entered system mode via the
684                                  * syscall lcall.  Continue single stepping
685                                  * silently until the syscall handler has
686                                  * saved the flags.
687                                  */
688                                 goto out2;
689                         }
690                         if (frame->tf_rip == (int)IDTVEC(syscall) + 1) {
691                                 /*
692                                  * The syscall handler has now saved the
693                                  * flags.  Stop single stepping it.
694                                  */
695                                 frame->tf_rflags &= ~PSL_T;
696                                 goto out2;
697                         }
698 #endif
699
700                         /*
701                          * Ignore debug register trace traps due to
702                          * accesses in the user's address space, which
703                          * can happen under several conditions such as
704                          * if a user sets a watchpoint on a buffer and
705                          * then passes that buffer to a system call.
706                          * We still want to get TRCTRAPS for addresses
707                          * in kernel space because that is useful when
708                          * debugging the kernel.
709                          */
710 #if JG
711                         if (user_dbreg_trap()) {
712                                 /*
713                                  * Reset breakpoint bits because the
714                                  * processor doesn't
715                                  */
716                                 /* XXX check upper bits here */
717                                 load_dr6(rdr6() & 0xfffffff0);
718                                 goto out2;
719                         }
720 #endif
721                         /*
722                          * FALLTHROUGH (TRCTRAP kernel mode, kernel address)
723                          */
724                 case T_BPTFLT:
725                         /*
726                          * If DDB is enabled, let it handle the debugger trap.
727                          * Otherwise, debugger traps "can't happen".
728                          */
729 #ifdef DDB
730                         MAKEMPSAFE(have_mplock);
731                         if (kdb_trap(type, 0, frame))
732                                 goto out2;
733 #endif
734                         break;
735
736                 case T_NMI:
737                         MAKEMPSAFE(have_mplock);
738                         /* machine/parity/power fail/"kitchen sink" faults */
739 #if NISA > 0
740                         if (isa_nmi(code) == 0) {
741 #ifdef DDB
742                                 /*
743                                  * NMI can be hooked up to a pushbutton
744                                  * for debugging.
745                                  */
746                                 if (ddb_on_nmi) {
747                                         kprintf ("NMI ... going to debugger\n");
748                                         kdb_trap(type, 0, frame);
749                                 }
750 #endif /* DDB */
751                                 goto out2;
752                         } else if (panic_on_nmi == 0)
753                                 goto out2;
754                         /* FALL THROUGH */
755 #endif /* NISA > 0 */
756                 }
757                 MAKEMPSAFE(have_mplock);
758                 trap_fatal(frame, 0);
759                 goto out2;
760         }
761
762         /*
763          * Virtual kernel intercept - if the fault is directly related to a
764          * VM context managed by a virtual kernel then let the virtual kernel
765          * handle it.
766          */
767         if (lp->lwp_vkernel && lp->lwp_vkernel->ve) {
768                 vkernel_trap(lp, frame);
769                 goto out2;
770         }
771
772         /*
773          * Virtual kernel intercept - if the fault is directly related to a
774          * VM context managed by a virtual kernel then let the virtual kernel
775          * handle it.
776          */
777         if (lp->lwp_vkernel && lp->lwp_vkernel->ve) {
778                 vkernel_trap(lp, frame);
779                 goto out;
780         }
781
782         /*
783          * Translate fault for emulators (e.g. Linux) 
784          */
785         if (*p->p_sysent->sv_transtrap)
786                 i = (*p->p_sysent->sv_transtrap)(i, type);
787
788         MAKEMPSAFE(have_mplock);
789         trapsignal(lp, i, ucode);
790
791 #ifdef DEBUG
792         if (type <= MAX_TRAP_MSG) {
793                 uprintf("fatal process exception: %s",
794                         trap_msg[type]);
795                 if ((type == T_PAGEFLT) || (type == T_PROTFLT))
796                         uprintf(", fault VA = 0x%lx", frame->tf_addr);
797                 uprintf("\n");
798         }
799 #endif
800
801 out:
802 #ifdef SMP
803         if (ISPL(frame->tf_cs) == SEL_UPL)
804                 KASSERT(td->td_mpcount == have_mplock, ("badmpcount trap/end from %p", (void *)frame->tf_rip));
805 #endif
806         userret(lp, frame, sticks);
807         userexit(lp);
808 out2:   ;
809 #ifdef SMP
810         if (have_mplock)
811                 rel_mplock();
812 #endif
813         if (p != NULL && lp != NULL)
814 #if JG
815                 KTR_LOG(kernentry_trap_ret, p->p_pid, lp->lwp_tid);
816 #else
817                 KTR_LOG_STR(kernentry_trap_ret, "pid=%d, tid=%d", p->p_pid, lp->lwp_tid);
818 #endif
819 #ifdef INVARIANTS
820         KASSERT(crit_count == (td->td_pri & ~TDPRI_MASK),
821                 ("syscall: critical section count mismatch! %d/%d",
822                 crit_count / TDPRI_CRIT, td->td_pri / TDPRI_CRIT));
823 #endif
824 }
825
826 static int
827 trap_pfault(struct trapframe *frame, int usermode)
828 {
829         vm_offset_t va;
830         struct vmspace *vm = NULL;
831         vm_map_t map;
832         int rv = 0;
833         vm_prot_t ftype;
834         thread_t td = curthread;
835         struct lwp *lp = td->td_lwp;
836
837         va = trunc_page(frame->tf_addr);
838         if (va >= VM_MIN_KERNEL_ADDRESS) {
839                 /*
840                  * Don't allow user-mode faults in kernel address space.
841                  */
842                 if (usermode)
843                         goto nogo;
844
845                 map = &kernel_map;
846         } else {
847                 /*
848                  * This is a fault on non-kernel virtual memory.
849                  * vm is initialized above to NULL. If curproc is NULL
850                  * or curproc->p_vmspace is NULL the fault is fatal.
851                  */
852                 if (lp != NULL)
853                         vm = lp->lwp_vmspace;
854
855                 if (vm == NULL)
856                         goto nogo;
857
858                 map = &vm->vm_map;
859         }
860
861         /*
862          * PGEX_I is defined only if the execute disable bit capability is
863          * supported and enabled.
864          */
865         if (frame->tf_err & PGEX_W)
866                 ftype = VM_PROT_WRITE;
867 #if JG
868         else if ((frame->tf_err & PGEX_I) && pg_nx != 0)
869                 ftype = VM_PROT_EXECUTE;
870 #endif
871         else
872                 ftype = VM_PROT_READ;
873
874         if (map != &kernel_map) {
875                 /*
876                  * Keep swapout from messing with us during this
877                  *      critical time.
878                  */
879                 PHOLD(lp->lwp_proc);
880
881                 /*
882                  * Grow the stack if necessary
883                  */
884                 /* grow_stack returns false only if va falls into
885                  * a growable stack region and the stack growth
886                  * fails.  It returns true if va was not within
887                  * a growable stack region, or if the stack 
888                  * growth succeeded.
889                  */
890                 if (!grow_stack(lp->lwp_proc, va)) {
891                         rv = KERN_FAILURE;
892                         PRELE(lp->lwp_proc);
893                         goto nogo;
894                 }
895
896                 /* Fault in the user page: */
897                 rv = vm_fault(map, va, ftype,
898                               (ftype & VM_PROT_WRITE) ? VM_FAULT_DIRTY
899                                                       : VM_FAULT_NORMAL);
900
901                 PRELE(lp->lwp_proc);
902         } else {
903                 /*
904                  * Don't have to worry about process locking or stacks
905                  * in the kernel.
906                  */
907                 rv = vm_fault(map, va, ftype, VM_FAULT_NORMAL);
908         }
909
910         if (rv == KERN_SUCCESS)
911                 return (0);
912 nogo:
913         if (!usermode) {
914                 if (td->td_gd->gd_intr_nesting_level == 0 &&
915                     td->td_pcb->pcb_onfault) {
916                         frame->tf_rip = (register_t)td->td_pcb->pcb_onfault;
917                         return (0);
918                 }
919                 trap_fatal(frame, frame->tf_addr);
920                 return (-1);
921         }
922
923         /*
924          * NOTE: on amd64 we have a tf_addr field in the trapframe, no
925          * kludge is needed to pass the fault address to signal handlers.
926          */
927
928         return((rv == KERN_PROTECTION_FAILURE) ? SIGBUS : SIGSEGV);
929 }
930
931 static void
932 trap_fatal(struct trapframe *frame, vm_offset_t eva)
933 {
934         int code, ss;
935         u_int type;
936         long rsp;
937         struct soft_segment_descriptor softseg;
938         char *msg;
939
940         code = frame->tf_err;
941         type = frame->tf_trapno;
942         sdtossd(&gdt[IDXSEL(frame->tf_cs & 0xffff)], &softseg);
943
944         if (type <= MAX_TRAP_MSG)
945                 msg = trap_msg[type];
946         else
947                 msg = "UNKNOWN";
948         kprintf("\n\nFatal trap %d: %s while in %s mode\n", type, msg,
949             ISPL(frame->tf_cs) == SEL_UPL ? "user" : "kernel");
950 #ifdef SMP
951         /* two separate prints in case of a trap on an unmapped page */
952         kprintf("cpuid = %d; ", PCPU_GET(cpuid));
953         kprintf("apic id = %02x\n", PCPU_GET(apic_id));
954 #endif
955         if (type == T_PAGEFLT) {
956                 kprintf("fault virtual address  = 0x%lx\n", eva);
957                 kprintf("fault code             = %s %s %s, %s\n",
958                         code & PGEX_U ? "user" : "supervisor",
959                         code & PGEX_W ? "write" : "read",
960                         code & PGEX_I ? "instruction" : "data",
961                         code & PGEX_P ? "protection violation" : "page not present");
962         }
963         kprintf("instruction pointer    = 0x%lx:0x%lx\n",
964                frame->tf_cs & 0xffff, frame->tf_rip);
965         if (ISPL(frame->tf_cs) == SEL_UPL) {
966                 ss = frame->tf_ss & 0xffff;
967                 rsp = frame->tf_rsp;
968         } else {
969                 ss = GSEL(GDATA_SEL, SEL_KPL);
970                 rsp = (long)&frame->tf_rsp;
971         }
972         kprintf("stack pointer          = 0x%x:0x%lx\n", ss, rsp);
973         kprintf("frame pointer          = 0x%x:0x%lx\n", ss, frame->tf_rbp);
974         kprintf("code segment           = base 0x%lx, limit 0x%lx, type 0x%x\n",
975                softseg.ssd_base, softseg.ssd_limit, softseg.ssd_type);
976         kprintf("                       = DPL %d, pres %d, long %d, def32 %d, gran %d\n",
977                softseg.ssd_dpl, softseg.ssd_p, softseg.ssd_long, softseg.ssd_def32,
978                softseg.ssd_gran);
979         kprintf("processor eflags       = ");
980         if (frame->tf_rflags & PSL_T)
981                 kprintf("trace trap, ");
982         if (frame->tf_rflags & PSL_I)
983                 kprintf("interrupt enabled, ");
984         if (frame->tf_rflags & PSL_NT)
985                 kprintf("nested task, ");
986         if (frame->tf_rflags & PSL_RF)
987                 kprintf("resume, ");
988         kprintf("IOPL = %ld\n", (frame->tf_rflags & PSL_IOPL) >> 12);
989         kprintf("current process                = ");
990         if (curproc) {
991                 kprintf("%lu\n",
992                     (u_long)curproc->p_pid);
993         } else {
994                 kprintf("Idle\n");
995         }
996         kprintf("current thread          = pri %d ", curthread->td_pri);
997         if (curthread->td_pri >= TDPRI_CRIT)
998                 kprintf("(CRIT)");
999         kprintf("\n");
1000
1001 #ifdef DDB
1002         if ((debugger_on_panic || db_active) && kdb_trap(type, code, frame))
1003                 return;
1004 #endif
1005         kprintf("trap number            = %d\n", type);
1006         if (type <= MAX_TRAP_MSG)
1007                 panic("%s", trap_msg[type]);
1008         else
1009                 panic("unknown/reserved trap");
1010 }
1011
1012 /*
1013  * Double fault handler. Called when a fault occurs while writing
1014  * a frame for a trap/exception onto the stack. This usually occurs
1015  * when the stack overflows (such is the case with infinite recursion,
1016  * for example).
1017  */
1018 void
1019 dblfault_handler(struct trapframe *frame)
1020 {
1021         kprintf0("DOUBLE FAULT\n");
1022         kprintf("\nFatal double fault\n");
1023         kprintf("rip = 0x%lx\n", frame->tf_rip);
1024         kprintf("rsp = 0x%lx\n", frame->tf_rsp);
1025         kprintf("rbp = 0x%lx\n", frame->tf_rbp);
1026 #ifdef SMP
1027         /* two separate prints in case of a trap on an unmapped page */
1028         kprintf("cpuid = %d; ", PCPU_GET(cpuid));
1029         kprintf("apic id = %02x\n", PCPU_GET(apic_id));
1030 #endif
1031         panic("double fault");
1032 }
1033
1034 /*
1035  *      syscall2 -      MP aware system call request C handler
1036  *
1037  *      A system call is essentially treated as a trap except that the
1038  *      MP lock is not held on entry or return.  We are responsible for
1039  *      obtaining the MP lock if necessary and for handling ASTs
1040  *      (e.g. a task switch) prior to return.
1041  *
1042  *      In general, only simple access and manipulation of curproc and
1043  *      the current stack is allowed without having to hold MP lock.
1044  *
1045  *      MPSAFE - note that large sections of this routine are run without
1046  *               the MP lock.
1047  */
1048 void
1049 syscall2(struct trapframe *frame)
1050 {
1051         struct thread *td = curthread;
1052         struct proc *p = td->td_proc;
1053         struct lwp *lp = td->td_lwp;
1054         caddr_t params;
1055         struct sysent *callp;
1056         register_t orig_tf_rflags;
1057         int sticks;
1058         int error;
1059         int narg;
1060 #ifdef INVARIANTS
1061         int crit_count = td->td_pri & ~TDPRI_MASK;
1062 #endif
1063 #ifdef SMP
1064         int have_mplock = 0;
1065 #endif
1066         register_t *argp;
1067         u_int code;
1068         int reg, regcnt;
1069         union sysunion args;
1070         register_t *argsdst;
1071         kprintf0("SYSCALL rip = %016llx\n", frame->tf_rip);
1072
1073         PCPU_INC(cnt.v_syscall);
1074
1075         kprintf0("\033[31mSYSCALL %ld\033[39m\n", frame->tf_rax);
1076 #ifdef DIAGNOSTIC
1077         if (ISPL(frame->tf_cs) != SEL_UPL) {
1078                 get_mplock();
1079                 panic("syscall");
1080                 /* NOT REACHED */
1081         }
1082 #endif
1083
1084 #if JG
1085         KTR_LOG(kernentry_syscall, p->p_pid, lp->lwp_tid,
1086                 frame->tf_eax);
1087 #else
1088         KTR_LOG_STR(kernentry_syscall, "pid=%d, tid=%d, call=%ld", p->p_pid, lp->lwp_tid,
1089                 frame->tf_rax);
1090 #endif
1091
1092 #ifdef SMP
1093         KASSERT(td->td_mpcount == 0, ("badmpcount syscall2 from %p", (void *)frame->tf_eip));
1094         if (syscall_mpsafe == 0)
1095                 MAKEMPSAFE(have_mplock);
1096 #endif
1097         userenter(td);          /* lazy raise our priority */
1098
1099         reg = 0;
1100         regcnt = 6;
1101         /*
1102          * Misc
1103          */
1104         sticks = (int)td->td_sticks;
1105         orig_tf_rflags = frame->tf_rflags;
1106
1107         /*
1108          * Virtual kernel intercept - if a VM context managed by a virtual
1109          * kernel issues a system call the virtual kernel handles it, not us.
1110          * Restore the virtual kernel context and return from its system
1111          * call.  The current frame is copied out to the virtual kernel.
1112          */
1113         if (lp->lwp_vkernel && lp->lwp_vkernel->ve) {
1114                 error = vkernel_trap(lp, frame);
1115                 frame->tf_rax = error;
1116                 if (error)
1117                         frame->tf_rflags |= PSL_C;
1118                 error = EJUSTRETURN;
1119                 goto out;
1120         }
1121
1122         /*
1123          * Get the system call parameters and account for time
1124          */
1125         lp->lwp_md.md_regs = frame;
1126         params = (caddr_t)frame->tf_rsp + sizeof(register_t);
1127         code = frame->tf_rax;
1128
1129         if (p->p_sysent->sv_prepsyscall) {
1130                 (*p->p_sysent->sv_prepsyscall)(
1131                         frame, (int *)(&args.nosys.sysmsg + 1),
1132                         &code, &params);
1133         } else {
1134                 if (code == SYS_syscall || code == SYS___syscall) {
1135                         code = frame->tf_rdi;
1136                         reg++;
1137                         regcnt--;
1138                 }
1139         }
1140
1141         if (p->p_sysent->sv_mask)
1142                 code &= p->p_sysent->sv_mask;
1143
1144         if (code >= p->p_sysent->sv_size)
1145                 callp = &p->p_sysent->sv_table[0];
1146         else
1147                 callp = &p->p_sysent->sv_table[code];
1148
1149         narg = callp->sy_narg & SYF_ARGMASK;
1150
1151         /*
1152          * On amd64 we get up to six arguments in registers. The rest are
1153          * on the stack. The first six members of 'struct trampframe' happen
1154          * to be the registers used to pass arguments, in exactly the right
1155          * order.
1156          */
1157         argp = &frame->tf_rdi;
1158         argp += reg;
1159         argsdst = (register_t *)(&args.nosys.sysmsg + 1);
1160         /*
1161          * JG can we overflow the space pointed to by 'argsdst'
1162          * either with 'bcopy' or with 'copyin'?
1163          */
1164         bcopy(argp, argsdst, sizeof(register_t) * regcnt);
1165         /*
1166          * copyin is MP aware, but the tracing code is not
1167          */
1168         if (narg > regcnt) {
1169                 KASSERT(params != NULL, ("copyin args with no params!"));
1170                 error = copyin(params, &argsdst[regcnt],
1171                         (narg - regcnt) * sizeof(register_t));
1172                 if (error) {
1173 #ifdef KTRACE
1174                         if (KTRPOINT(td, KTR_SYSCALL)) {
1175                                 MAKEMPSAFE(have_mplock);
1176                                 
1177                                 ktrsyscall(lp, code, narg,
1178                                         (void *)(&args.nosys.sysmsg + 1));
1179                         }
1180 #endif
1181                         goto bad;
1182                 }
1183         }
1184
1185 #ifdef KTRACE
1186         if (KTRPOINT(td, KTR_SYSCALL)) {
1187                 MAKEMPSAFE(have_mplock);
1188                 ktrsyscall(lp, code, narg, (void *)(&args.nosys.sysmsg + 1));
1189         }
1190 #endif
1191
1192         /*
1193          * Default return value is 0 (will be copied to %rax).  Double-value
1194          * returns use %rax and %rdx.  %rdx is left unchanged for system
1195          * calls which return only one result.
1196          */
1197         args.sysmsg_fds[0] = 0;
1198         args.sysmsg_fds[1] = frame->tf_rdx;
1199
1200         /*
1201          * The syscall might manipulate the trap frame. If it does it
1202          * will probably return EJUSTRETURN.
1203          */
1204         args.sysmsg_frame = frame;
1205
1206         STOPEVENT(p, S_SCE, narg);      /* MP aware */
1207
1208 #ifdef SMP
1209         /*
1210          * Try to run the syscall without the MP lock if the syscall
1211          * is MP safe.  We have to obtain the MP lock no matter what if 
1212          * we are ktracing
1213          */
1214         if ((callp->sy_narg & SYF_MPSAFE) == 0)
1215                 MAKEMPSAFE(have_mplock);
1216 #endif
1217
1218         error = (*callp->sy_call)(&args);
1219
1220 out:
1221         /*
1222          * MP SAFE (we may or may not have the MP lock at this point)
1223          */
1224         //kprintf("SYSMSG %d ", error);
1225         switch (error) {
1226         case 0:
1227                 /*
1228                  * Reinitialize proc pointer `p' as it may be different
1229                  * if this is a child returning from fork syscall.
1230                  */
1231                 p = curproc;
1232                 lp = curthread->td_lwp;
1233                 frame->tf_rax = args.sysmsg_fds[0];
1234                 frame->tf_rdx = args.sysmsg_fds[1];
1235                 kprintf0("RESULT %lld %lld\n", frame->tf_rax, frame->tf_rdx);
1236                 frame->tf_rflags &= ~PSL_C;
1237                 break;
1238         case ERESTART:
1239                 /*
1240                  * Reconstruct pc, we know that 'syscall' is 2 bytes.
1241                  * We have to do a full context restore so that %r10
1242                  * (which was holding the value of %rcx) is restored for
1243                  * the next iteration.
1244                  */
1245                 frame->tf_rip -= frame->tf_err;
1246                 frame->tf_r10 = frame->tf_rcx;
1247                 td->td_pcb->pcb_flags |= PCB_FULLCTX;
1248                 break;
1249         case EJUSTRETURN:
1250                 break;
1251         case EASYNC:
1252                 panic("Unexpected EASYNC return value (for now)");
1253         default:
1254 bad:
1255                 if (p->p_sysent->sv_errsize) {
1256                         if (error >= p->p_sysent->sv_errsize)
1257                                 error = -1;     /* XXX */
1258                         else
1259                                 error = p->p_sysent->sv_errtbl[error];
1260                 }
1261                 kprintf0("ERROR %d\n", error);
1262                 frame->tf_rax = error;
1263                 frame->tf_rflags |= PSL_C;
1264                 break;
1265         }
1266
1267         /*
1268          * Traced syscall.  trapsignal() is not MP aware.
1269          */
1270         if (orig_tf_rflags & PSL_T) {
1271                 MAKEMPSAFE(have_mplock);
1272                 frame->tf_rflags &= ~PSL_T;
1273                 trapsignal(lp, SIGTRAP, 0);
1274         }
1275
1276         /*
1277          * Handle reschedule and other end-of-syscall issues
1278          */
1279         userret(lp, frame, sticks);
1280
1281 #ifdef KTRACE
1282         if (KTRPOINT(td, KTR_SYSRET)) {
1283                 MAKEMPSAFE(have_mplock);
1284                 ktrsysret(lp, code, error, args.sysmsg_result);
1285         }
1286 #endif
1287
1288         /*
1289          * This works because errno is findable through the
1290          * register set.  If we ever support an emulation where this
1291          * is not the case, this code will need to be revisited.
1292          */
1293         STOPEVENT(p, S_SCX, code);
1294
1295         userexit(lp);
1296 #ifdef SMP
1297         /*
1298          * Release the MP lock if we had to get it
1299          */
1300         KASSERT(td->td_mpcount == have_mplock, 
1301                 ("badmpcount syscall2/end from %p", (void *)frame->tf_eip));
1302         if (have_mplock)
1303                 rel_mplock();
1304 #endif
1305 #if JG
1306         KTR_LOG(kernentry_syscall_ret, p->p_pid, lp->lwp_tid, error);
1307 #else
1308         KTR_LOG_STR(kernentry_syscall_ret, "pid=%d, tid=%d, err=%d", p->p_pid, lp->lwp_tid, error);
1309 #endif
1310 #ifdef INVARIANTS
1311         KASSERT(crit_count == (td->td_pri & ~TDPRI_MASK), 
1312                 ("syscall: critical section count mismatch! %d/%d",
1313                 crit_count / TDPRI_CRIT, td->td_pri / TDPRI_CRIT));
1314 #endif
1315 }
1316
1317 void
1318 fork_return(struct lwp *lp, struct trapframe *frame)
1319 {
1320         kprintf0("fork return\n");
1321         frame->tf_rax = 0;              /* Child returns zero */
1322         frame->tf_rflags &= ~PSL_C;     /* success */
1323         frame->tf_rdx = 1;
1324
1325         generic_lwp_return(lp, frame);
1326 #if JG
1327         KTR_LOG(kernentry_fork_ret, lp->lwp_proc->p_pid, lp->lwp_tid);
1328 #else
1329         KTR_LOG_STR(kernentry_fork_ret, "pid=%d, tid=%d", lp->lwp_proc->p_pid, lp->lwp_tid);
1330 #endif
1331 }
1332
1333 /*
1334  * Simplified back end of syscall(), used when returning from fork()
1335  * directly into user mode.  MP lock is held on entry and should be
1336  * released on return.  This code will return back into the fork
1337  * trampoline code which then runs doreti.
1338  */
1339 void
1340 generic_lwp_return(struct lwp *lp, struct trapframe *frame)
1341 {
1342         kprintf0("generic_lwp_return\n");
1343         struct proc *p = lp->lwp_proc;
1344
1345         /*
1346          * Newly forked processes are given a kernel priority.  We have to
1347          * adjust the priority to a normal user priority and fake entry
1348          * into the kernel (call userenter()) to install a passive release
1349          * function just in case userret() decides to stop the process.  This
1350          * can occur when ^Z races a fork.  If we do not install the passive
1351          * release function the current process designation will not be
1352          * released when the thread goes to sleep.
1353          */
1354         lwkt_setpri_self(TDPRI_USER_NORM);
1355         userenter(lp->lwp_thread);
1356         userret(lp, frame, 0);
1357 #ifdef KTRACE
1358         if (KTRPOINT(lp->lwp_thread, KTR_SYSRET))
1359                 ktrsysret(lp, SYS_fork, 0, 0);
1360 #endif
1361         p->p_flag |= P_PASSIVE_ACQ;
1362         userexit(lp);
1363         p->p_flag &= ~P_PASSIVE_ACQ;
1364 #ifdef SMP
1365         KKASSERT(lp->lwp_thread->td_mpcount == 1);
1366         rel_mplock();
1367 #endif
1368 }
1369
1370 /*
1371  * If PGEX_FPFAULT is set then set FP_VIRTFP in the PCB to force a T_DNA
1372  * fault (which is then passed back to the virtual kernel) if an attempt is
1373  * made to use the FP unit.
1374  *
1375  * XXX this is a fairly big hack.
1376  */
1377 void
1378 set_vkernel_fp(struct trapframe *frame)
1379 {
1380         /* JGXXX */
1381 }