AMD64 - Correct wire_count, statistics, and other pmap fixes and cleanups

[dragonfly.git] / sys / platform / pc64 / amd64 / trap.c

/*-
 * Copyright (c) 1990, 1993
 *      The Regents of the University of California.  All rights reserved.
 * Copyright (C) 1994, David Greenman
 * Copyright (c) 2008 The DragonFly Project.
 * Copyright (c) 2008 Jordan Gordeev.
 *
 * This code is derived from software contributed to Berkeley by
 * the University of Utah, and William Jolitz.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *      This product includes software developed by the University of
 *      California, Berkeley and its contributors.
 * 4. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 * from: @(#)trap.c     7.4 (Berkeley) 5/13/91
 * $FreeBSD: src/sys/i386/i386/trap.c,v 1.147.2.11 2003/02/27 19:09:59 luoqi Exp $
 * $DragonFly: src/sys/platform/pc64/amd64/trap.c,v 1.3 2008/09/09 04:06:18 dillon Exp $
 */

/*
 * AMD64 Trap and System call handling
 */

#include "opt_ddb.h"
#include "opt_ktrace.h"

#include <machine/frame.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/proc.h>
#include <sys/pioctl.h>
#include <sys/types.h>
#include <sys/signal2.h>
#include <sys/syscall.h>
#include <sys/sysctl.h>
#include <sys/sysent.h>
#include <sys/systm.h>
#ifdef KTRACE
#include <sys/ktrace.h>
#endif
#include <sys/ktr.h>
#include <sys/sysmsg.h>
#include <sys/sysproto.h>
#include <sys/sysunion.h>

#include <vm/pmap.h>
#include <vm/vm.h>
#include <vm/vm_extern.h>
#include <vm/vm_kern.h>
#include <vm/vm_param.h>
#include <machine/cpu.h>
#include <machine/pcb.h>
#include <machine/smp.h>
#include <machine/thread.h>
#include <machine/vmparam.h>
#include <machine/md_var.h>
#include <machine_base/isa/intr_machdep.h>

#include <ddb/ddb.h>
#include <sys/thread2.h>

#ifdef SMP

#define MAKEMPSAFE(have_mplock)                 \
        if (have_mplock == 0) {                 \
                get_mplock();                   \
                have_mplock = 1;                \
        }

#else

#define MAKEMPSAFE(have_mplock)

#endif

extern void trap(struct trapframe *frame);

static int trap_pfault(struct trapframe *, int);
static void trap_fatal(struct trapframe *, vm_offset_t);
void dblfault_handler(struct trapframe *frame);

#define MAX_TRAP_MSG            30
static char *trap_msg[] = {
        "",                                     /*  0 unused */
        "privileged instruction fault",         /*  1 T_PRIVINFLT */
        "",                                     /*  2 unused */
        "breakpoint instruction fault",         /*  3 T_BPTFLT */
        "",                                     /*  4 unused */
        "",                                     /*  5 unused */
        "arithmetic trap",                      /*  6 T_ARITHTRAP */
        "system forced exception",              /*  7 T_ASTFLT */
        "",                                     /*  8 unused */
        "general protection fault",             /*  9 T_PROTFLT */
        "trace trap",                           /* 10 T_TRCTRAP */
        "",                                     /* 11 unused */
        "page fault",                           /* 12 T_PAGEFLT */
        "",                                     /* 13 unused */
        "alignment fault",                      /* 14 T_ALIGNFLT */
        "",                                     /* 15 unused */
        "",                                     /* 16 unused */
        "",                                     /* 17 unused */
        "integer divide fault",                 /* 18 T_DIVIDE */
        "non-maskable interrupt trap",          /* 19 T_NMI */
        "overflow trap",                        /* 20 T_OFLOW */
        "FPU bounds check fault",               /* 21 T_BOUND */
        "FPU device not available",             /* 22 T_DNA */
        "double fault",                         /* 23 T_DOUBLEFLT */
        "FPU operand fetch fault",              /* 24 T_FPOPFLT */
        "invalid TSS fault",                    /* 25 T_TSSFLT */
        "segment not present fault",            /* 26 T_SEGNPFLT */
        "stack fault",                          /* 27 T_STKFLT */
        "machine check trap",                   /* 28 T_MCHK */
        "SIMD floating-point exception",        /* 29 T_XMMFLT */
        "reserved (unknown) fault",             /* 30 T_RESERVED */
};

#ifdef DDB
static int ddb_on_nmi = 1;
SYSCTL_INT(_machdep, OID_AUTO, ddb_on_nmi, CTLFLAG_RW,
        &ddb_on_nmi, 0, "Go to DDB on NMI");
#endif
static int panic_on_nmi = 1;
SYSCTL_INT(_machdep, OID_AUTO, panic_on_nmi, CTLFLAG_RW,
        &panic_on_nmi, 0, "Panic on NMI");
static int fast_release;
SYSCTL_INT(_machdep, OID_AUTO, fast_release, CTLFLAG_RW,
        &fast_release, 0, "Passive Release was optimal");
static int slow_release;
SYSCTL_INT(_machdep, OID_AUTO, slow_release, CTLFLAG_RW,
        &slow_release, 0, "Passive Release was nonoptimal");
#ifdef SMP
static int syscall_mpsafe = 1;
SYSCTL_INT(_kern, OID_AUTO, syscall_mpsafe, CTLFLAG_RW,
        &syscall_mpsafe, 0, "Allow MPSAFE marked syscalls to run without BGL");
TUNABLE_INT("kern.syscall_mpsafe", &syscall_mpsafe);
static int trap_mpsafe = 1;
SYSCTL_INT(_kern, OID_AUTO, trap_mpsafe, CTLFLAG_RW,
        &trap_mpsafe, 0, "Allow traps to mostly run without the BGL");
TUNABLE_INT("kern.trap_mpsafe", &trap_mpsafe);
#endif

/*
 * userenter() passively intercepts the thread switch function to increase
 * the thread priority from a user priority to a kernel priority, reducing
 * syscall and trap overhead for the case where no switch occurs.
 */

static __inline void
userenter(struct thread *curtd)
{
        curtd->td_release = lwkt_passive_release;
}

/*
 * Handle signals, upcalls, profiling, and other AST's and/or tasks that
 * must be completed before we can return to or try to return to userland.
 *
 * Note that td_sticks is a 64 bit quantity, but there's no point doing 64
 * arithmatic on the delta calculation so the absolute tick values are
 * truncated to an integer.
 */
static void
userret(struct lwp *lp, struct trapframe *frame, int sticks)
{
        struct proc *p = lp->lwp_proc;
        int sig;

        /*
         * Charge system time if profiling.  Note: times are in microseconds.
         * This may do a copyout and block, so do it first even though it
         * means some system time will be charged as user time.
         */
        if (p->p_flag & P_PROFIL) {
                addupc_task(p, frame->tf_rip, 
                        (u_int)((int)lp->lwp_thread->td_sticks - sticks));
        }

recheck:
        /*
         * If the jungle wants us dead, so be it.
         */
        if (lp->lwp_flag & LWP_WEXIT) {
                get_mplock();
                lwp_exit(0);
                rel_mplock(); /* NOT REACHED */
        }

        /*
         * Block here if we are in a stopped state.
         */
        if (p->p_stat == SSTOP) {
                get_mplock();
                tstop();
                rel_mplock();
                goto recheck;
        }

        /*
         * Post any pending upcalls.  If running a virtual kernel be sure
         * to restore the virtual kernel's vmspace before posting the upcall.
         */
        if (p->p_flag & P_UPCALLPEND) {
                p->p_flag &= ~P_UPCALLPEND;
                get_mplock();
                postupcall(lp);
                rel_mplock();
                goto recheck;
        }

        /*
         * Post any pending signals.  If running a virtual kernel be sure
         * to restore the virtual kernel's vmspace before posting the signal.
         */
        if ((sig = CURSIG_TRACE(lp)) != 0) {
                get_mplock();
                postsig(sig);
                rel_mplock();
                goto recheck;
        }

        /*
         * block here if we are swapped out, but still process signals
         * (such as SIGKILL).  proc0 (the swapin scheduler) is already
         * aware of our situation, we do not have to wake it up.
         */
        if (p->p_flag & P_SWAPPEDOUT) {
                get_mplock();
                p->p_flag |= P_SWAPWAIT;
                swapin_request();
                if (p->p_flag & P_SWAPWAIT)
                        tsleep(p, PCATCH, "SWOUT", 0);
                p->p_flag &= ~P_SWAPWAIT;
                rel_mplock();
                goto recheck;
        }

        /*
         * Make sure postsig() handled request to restore old signal mask after
         * running signal handler.
         */
        KKASSERT((lp->lwp_flag & LWP_OLDMASK) == 0);
}

/*
 * Cleanup from userenter and any passive release that might have occured.
 * We must reclaim the current-process designation before we can return
 * to usermode.  We also handle both LWKT and USER reschedule requests.
 */
static __inline void
userexit(struct lwp *lp)
{
        struct thread *td = lp->lwp_thread;
/*      globaldata_t gd = td->td_gd;*/

        /*
         * Handle stop requests at kernel priority.  Any requests queued
         * after this loop will generate another AST.
         */
        while (lp->lwp_proc->p_stat == SSTOP) {
                get_mplock();
                tstop();
                rel_mplock();
        }

        /*
         * Reduce our priority in preparation for a return to userland.  If
         * our passive release function was still in place, our priority was
         * never raised and does not need to be reduced.
         */
        lwkt_passive_recover(td);

        /*
         * Become the current user scheduled process if we aren't already,
         * and deal with reschedule requests and other factors.
         */
        lp->lwp_proc->p_usched->acquire_curproc(lp);
        /* WARNING: we may have migrated cpu's */
        /* gd = td->td_gd; */
}

#if !defined(KTR_KERNENTRY)
#define KTR_KERNENTRY   KTR_ALL
#endif
KTR_INFO_MASTER(kernentry);
KTR_INFO(KTR_KERNENTRY, kernentry, trap, 0, "STR",
         sizeof(long) + sizeof(long) + sizeof(long) + sizeof(vm_offset_t));
KTR_INFO(KTR_KERNENTRY, kernentry, trap_ret, 0, "STR",
         sizeof(long) + sizeof(long));
KTR_INFO(KTR_KERNENTRY, kernentry, syscall, 0, "STR",
         sizeof(long) + sizeof(long) + sizeof(long));
KTR_INFO(KTR_KERNENTRY, kernentry, syscall_ret, 0, "STR",
         sizeof(long) + sizeof(long) + sizeof(long));
KTR_INFO(KTR_KERNENTRY, kernentry, fork_ret, 0, "STR",
         sizeof(long) + sizeof(long));

/*
 * Exception, fault, and trap interface to the kernel.
 * This common code is called from assembly language IDT gate entry
 * routines that prepare a suitable stack frame, and restore this
 * frame after the exception has been processed.
 *
 * This function is also called from doreti in an interlock to handle ASTs.
 * For example:  hardwareint->INTROUTINE->(set ast)->doreti->trap
 *
 * NOTE!  We have to retrieve the fault address prior to obtaining the
 * MP lock because get_mplock() may switch out.  YYY cr2 really ought
 * to be retrieved by the assembly code, not here.
 *
 * XXX gd_trap_nesting_level currently prevents lwkt_switch() from panicing
 * if an attempt is made to switch from a fast interrupt or IPI.  This is
 * necessary to properly take fatal kernel traps on SMP machines if 
 * get_mplock() has to block.
 */

void
trap(struct trapframe *frame)
{
        struct globaldata *gd = mycpu;
        struct thread *td = gd->gd_curthread;
        struct lwp *lp = td->td_lwp;
        struct proc *p;
        int sticks = 0;
        int i = 0, ucode = 0, type, code;
#ifdef SMP
        int have_mplock = 0;
#endif
#ifdef INVARIANTS
        int crit_count = td->td_pri & ~TDPRI_MASK;
#endif
        vm_offset_t eva;

        p = td->td_proc;

#ifdef JG
        kprintf0("TRAP ");
        kprintf0("\"%s\" type=%ld\n",
                trap_msg[frame->tf_trapno], frame->tf_trapno);
        kprintf0(" rip=%lx rsp=%lx\n", frame->tf_rip, frame->tf_rsp);
        kprintf0(" err=%lx addr=%lx\n", frame->tf_err, frame->tf_addr);
        kprintf0(" cs=%lx ss=%lx rflags=%lx\n", (unsigned long)frame->tf_cs, (unsigned long)frame->tf_ss, frame->tf_rflags);
#endif

#ifdef DDB
        if (db_active) {
                ++gd->gd_trap_nesting_level;
                MAKEMPSAFE(have_mplock);
                trap_fatal(frame, frame->tf_addr);
                --gd->gd_trap_nesting_level;
                goto out2;
        }
#endif
#ifdef DDB
        if (db_active) {
                eva = (frame->tf_trapno == T_PAGEFLT ? frame->tf_addr : 0);
                ++gd->gd_trap_nesting_level;
                MAKEMPSAFE(have_mplock);
                trap_fatal(frame, eva);
                --gd->gd_trap_nesting_level;
                goto out2;
        }
#endif

        eva = 0;

#ifdef SMP
        if (trap_mpsafe == 0) {
                ++gd->gd_trap_nesting_level;
                MAKEMPSAFE(have_mplock);
                --gd->gd_trap_nesting_level;
        }
#endif

        if ((frame->tf_rflags & PSL_I) == 0) {
                /*
                 * Buggy application or kernel code has disabled interrupts
                 * and then trapped.  Enabling interrupts now is wrong, but
                 * it is better than running with interrupts disabled until
                 * they are accidentally enabled later.
                 */
                type = frame->tf_trapno;
                if (ISPL(frame->tf_cs) == SEL_UPL) {
                        MAKEMPSAFE(have_mplock);
                        /* JG curproc can be NULL */
                        kprintf(
                            "pid %ld (%s): trap %d with interrupts disabled\n",
                            (long)curproc->p_pid, curproc->p_comm, type);
                } else if (type != T_NMI && type != T_BPTFLT &&
                    type != T_TRCTRAP) {
                        /*
                         * XXX not quite right, since this may be for a
                         * multiple fault in user mode.
                         */
                        MAKEMPSAFE(have_mplock);
                        kprintf("kernel trap %d with interrupts disabled\n",
                            type);
                }
                cpu_enable_intr();
        }

        type = frame->tf_trapno;
        code = frame->tf_err;

        if (ISPL(frame->tf_cs) == SEL_UPL) {
                /* user trap */

                KTR_LOG(kernentry_trap, p->p_pid, lp->lwp_tid,
                        frame->tf_trapno, eva);

                userenter(td);

                sticks = (int)td->td_sticks;
                lp->lwp_md.md_regs = frame;

                switch (type) {
                case T_PRIVINFLT:       /* privileged instruction fault */
                        ucode = ILL_PRVOPC;
                        i = SIGILL;
                        break;

                case T_BPTFLT:          /* bpt instruction fault */
                case T_TRCTRAP:         /* trace trap */
                        frame->tf_rflags &= ~PSL_T;
                        i = SIGTRAP;
                        break;

                case T_ARITHTRAP:       /* arithmetic trap */
                        ucode = code;
                        i = SIGFPE;
#if 0
#if JG
                        ucode = fputrap();
#else
                        ucode = code;
#endif
                        i = SIGFPE;
#endif
                        break;

                case T_ASTFLT:          /* Allow process switch */
                        mycpu->gd_cnt.v_soft++;
                        if (mycpu->gd_reqflags & RQF_AST_OWEUPC) {
                                atomic_clear_int_nonlocked(&mycpu->gd_reqflags,
                                            RQF_AST_OWEUPC);
                                addupc_task(p, p->p_prof.pr_addr,
                                            p->p_prof.pr_ticks);
                        }
                        goto out;

                case T_PROTFLT:         /* general protection fault */
                case T_SEGNPFLT:        /* segment not present fault */
                case T_TSSFLT:          /* invalid TSS fault */
                case T_DOUBLEFLT:       /* double fault */
                default:
                        ucode = code + BUS_SEGM_FAULT ;
                        i = SIGBUS;
                        break;

                case T_PAGEFLT:         /* page fault */
                        MAKEMPSAFE(have_mplock);
                        i = trap_pfault(frame, TRUE);
                        if (frame->tf_rip == 0)
                                kprintf("T_PAGEFLT: Warning %%rip == 0!\n");
                        if (i == -1)
                                goto out;
                        if (i == 0)
                                goto out;

                        ucode = T_PAGEFLT;
                        break;

                case T_DIVIDE:          /* integer divide fault */
                        ucode = FPE_INTDIV;
                        i = SIGFPE;
                        break;

                case T_NMI:
                        MAKEMPSAFE(have_mplock);
                        /* machine/parity/power fail/"kitchen sink" faults */
                        if (isa_nmi(code) == 0) {
#ifdef DDB
                                /*
                                 * NMI can be hooked up to a pushbutton
                                 * for debugging.
                                 */
                                if (ddb_on_nmi) {
                                        kprintf ("NMI ... going to debugger\n");
                                        kdb_trap(type, 0, frame);
                                }
#endif /* DDB */
                                goto out2;
                        } else if (panic_on_nmi)
                                panic("NMI indicates hardware failure");
                        break;

                case T_OFLOW:           /* integer overflow fault */
                        ucode = FPE_INTOVF;
                        i = SIGFPE;
                        break;

                case T_BOUND:           /* bounds check fault */
                        ucode = FPE_FLTSUB;
                        i = SIGFPE;
                        break;

                case T_DNA:
                        /*
                         * Virtual kernel intercept - pass the DNA exception
                         * to the virtual kernel if it asked to handle it.
                         * This occurs when the virtual kernel is holding
                         * onto the FP context for a different emulated
                         * process then the one currently running.
                         *
                         * We must still call npxdna() since we may have
                         * saved FP state that the virtual kernel needs
                         * to hand over to a different emulated process.
                         */
                        if (lp->lwp_vkernel && lp->lwp_vkernel->ve &&
                            (td->td_pcb->pcb_flags & FP_VIRTFP)
                        ) {
                                npxdna();
                                break;
                        }

                        /*
                         * The kernel may have switched out the FP unit's
                         * state, causing the user process to take a fault
                         * when it tries to use the FP unit.  Restore the
                         * state here
                         */
                        if (npxdna())
                                goto out;
                        i = SIGFPE;
                        ucode = FPE_FPU_NP_TRAP;
                        break;

                case T_FPOPFLT:         /* FPU operand fetch fault */
                        ucode = T_FPOPFLT;
                        i = SIGILL;
                        break;

                case T_XMMFLT:          /* SIMD floating-point exception */
                        ucode = 0; /* XXX */
                        i = SIGFPE;
                        break;
                }
        } else {
                /* kernel trap */

                switch (type) {
                case T_PAGEFLT:                 /* page fault */
                        MAKEMPSAFE(have_mplock);
                        trap_pfault(frame, FALSE);
                        goto out2;

                case T_DNA:
                        /*
                         * The kernel is apparently using fpu for copying.
                         * XXX this should be fatal unless the kernel has
                         * registered such use.
                         */
                        if (npxdna())
                                goto out2;
                        break;

                case T_STKFLT:          /* stack fault */
                        break;

                case T_PROTFLT:         /* general protection fault */
                case T_SEGNPFLT:        /* segment not present fault */
                        /*
                         * Invalid segment selectors and out of bounds
                         * %rip's and %rsp's can be set up in user mode.
                         * This causes a fault in kernel mode when the
                         * kernel tries to return to user mode.  We want
                         * to get this fault so that we can fix the
                         * problem here and not have to check all the
                         * selectors and pointers when the user changes
                         * them.
                         */
                        kprintf("trap.c line %d\n", __LINE__);
                        if (mycpu->gd_intr_nesting_level == 0) {
                                if (td->td_pcb->pcb_onfault) {
                                        frame->tf_rip = (register_t)
                                                td->td_pcb->pcb_onfault;
                                        goto out2;
                                }
                                if (frame->tf_rip == (long)doreti_iret) {
                                        frame->tf_rip = (long)doreti_iret_fault;
                                        goto out2;
                                }
                        }
                        break;

                case T_TSSFLT:
                        /*
                         * PSL_NT can be set in user mode and isn't cleared
                         * automatically when the kernel is entered.  This
                         * causes a TSS fault when the kernel attempts to
                         * `iret' because the TSS link is uninitialized.  We
                         * want to get this fault so that we can fix the
                         * problem here and not every time the kernel is
                         * entered.
                         */
                        if (frame->tf_rflags & PSL_NT) {
                                frame->tf_rflags &= ~PSL_NT;
                                goto out2;
                        }
                        break;

                case T_TRCTRAP:  /* trace trap */
#if 0
                        if (frame->tf_rip == (int)IDTVEC(syscall)) {
                                /*
                                 * We've just entered system mode via the
                                 * syscall lcall.  Continue single stepping
                                 * silently until the syscall handler has
                                 * saved the flags.
                                 */
                                goto out2;
                        }
                        if (frame->tf_rip == (int)IDTVEC(syscall) + 1) {
                                /*
                                 * The syscall handler has now saved the
                                 * flags.  Stop single stepping it.
                                 */
                                frame->tf_rflags &= ~PSL_T;
                                goto out2;
                        }
#endif

                        /*
                         * Ignore debug register trace traps due to
                         * accesses in the user's address space, which
                         * can happen under several conditions such as
                         * if a user sets a watchpoint on a buffer and
                         * then passes that buffer to a system call.
                         * We still want to get TRCTRAPS for addresses
                         * in kernel space because that is useful when
                         * debugging the kernel.
                         */
#if JG
                        if (user_dbreg_trap()) {
                                /*
                                 * Reset breakpoint bits because the
                                 * processor doesn't
                                 */
                                /* XXX check upper bits here */
                                load_dr6(rdr6() & 0xfffffff0);
                                goto out2;
                        }
#endif
                        /*
                         * FALLTHROUGH (TRCTRAP kernel mode, kernel address)
                         */
                case T_BPTFLT:
                        /*
                         * If DDB is enabled, let it handle the debugger trap.
                         * Otherwise, debugger traps "can't happen".
                         */
#ifdef DDB
                        MAKEMPSAFE(have_mplock);
                        if (kdb_trap(type, 0, frame))
                                goto out2;
#endif
                        break;

                case T_NMI:
                        MAKEMPSAFE(have_mplock);
                        /* machine/parity/power fail/"kitchen sink" faults */
#if NISA > 0
                        if (isa_nmi(code) == 0) {
#ifdef DDB
                                /*
                                 * NMI can be hooked up to a pushbutton
                                 * for debugging.
                                 */
                                if (ddb_on_nmi) {
                                        kprintf ("NMI ... going to debugger\n");
                                        kdb_trap(type, 0, frame);
                                }
#endif /* DDB */
                                goto out2;
                        } else if (panic_on_nmi == 0)
                                goto out2;
                        /* FALL THROUGH */
#endif /* NISA > 0 */
                }
                MAKEMPSAFE(have_mplock);
                trap_fatal(frame, 0);
                goto out2;
        }

        /*
         * Virtual kernel intercept - if the fault is directly related to a
         * VM context managed by a virtual kernel then let the virtual kernel
         * handle it.
         */
        if (lp->lwp_vkernel && lp->lwp_vkernel->ve) {
                vkernel_trap(lp, frame);
                goto out2;
        }

        /*
         * Virtual kernel intercept - if the fault is directly related to a
         * VM context managed by a virtual kernel then let the virtual kernel
         * handle it.
         */
        if (lp->lwp_vkernel && lp->lwp_vkernel->ve) {
                vkernel_trap(lp, frame);
                goto out;
        }

        /*
         * Translate fault for emulators (e.g. Linux) 
         */
        if (*p->p_sysent->sv_transtrap)
                i = (*p->p_sysent->sv_transtrap)(i, type);

        MAKEMPSAFE(have_mplock);
        trapsignal(lp, i, ucode);

#ifdef DEBUG
        if (type <= MAX_TRAP_MSG) {
                uprintf("fatal process exception: %s",
                        trap_msg[type]);
                if ((type == T_PAGEFLT) || (type == T_PROTFLT))
                        uprintf(", fault VA = 0x%lx", frame->tf_addr);
                uprintf("\n");
        }
#endif

out:
#ifdef SMP
        if (ISPL(frame->tf_cs) == SEL_UPL)
                KASSERT(td->td_mpcount == have_mplock, ("badmpcount trap/end from %p", (void *)frame->tf_rip));
#endif
        userret(lp, frame, sticks);
        userexit(lp);
out2:   ;
#ifdef SMP
        if (have_mplock)
                rel_mplock();
#endif
        if (p != NULL && lp != NULL)
                KTR_LOG(kernentry_trap_ret, p->p_pid, lp->lwp_tid);
#ifdef INVARIANTS
        KASSERT(crit_count == (td->td_pri & ~TDPRI_MASK),
                ("syscall: critical section count mismatch! %d/%d",
                crit_count / TDPRI_CRIT, td->td_pri / TDPRI_CRIT));
#endif
}

static int
trap_pfault(struct trapframe *frame, int usermode)
{
        vm_offset_t va;
        struct vmspace *vm = NULL;
        vm_map_t map;
        int rv = 0;
        vm_prot_t ftype;
        thread_t td = curthread;
        struct lwp *lp = td->td_lwp;

        va = trunc_page(frame->tf_addr);
        if (va >= VM_MIN_KERNEL_ADDRESS) {
                /*
                 * Don't allow user-mode faults in kernel address space.
                 */
                if (usermode)
                        goto nogo;

                map = &kernel_map;
        } else {
                /*
                 * This is a fault on non-kernel virtual memory.
                 * vm is initialized above to NULL. If curproc is NULL
                 * or curproc->p_vmspace is NULL the fault is fatal.
                 */
                if (lp != NULL)
                        vm = lp->lwp_vmspace;

                if (vm == NULL)
                        goto nogo;

                map = &vm->vm_map;
        }

        /*
         * PGEX_I is defined only if the execute disable bit capability is
         * supported and enabled.
         */
        if (frame->tf_err & PGEX_W)
                ftype = VM_PROT_WRITE;
#if JG
        else if ((frame->tf_err & PGEX_I) && pg_nx != 0)
                ftype = VM_PROT_EXECUTE;
#endif
        else
                ftype = VM_PROT_READ;

        if (map != &kernel_map) {
                /*
                 * Keep swapout from messing with us during this
                 *      critical time.
                 */
                PHOLD(lp->lwp_proc);

                /*
                 * Grow the stack if necessary
                 */
                /* grow_stack returns false only if va falls into
                 * a growable stack region and the stack growth
                 * fails.  It returns true if va was not within
                 * a growable stack region, or if the stack 
                 * growth succeeded.
                 */
                if (!grow_stack(lp->lwp_proc, va)) {
                        rv = KERN_FAILURE;
                        PRELE(lp->lwp_proc);
                        goto nogo;
                }

                /* Fault in the user page: */
                rv = vm_fault(map, va, ftype,
                              (ftype & VM_PROT_WRITE) ? VM_FAULT_DIRTY
                                                      : VM_FAULT_NORMAL);

                PRELE(lp->lwp_proc);
        } else {
                /*
                 * Don't have to worry about process locking or stacks
                 * in the kernel.
                 */
                rv = vm_fault(map, va, ftype, VM_FAULT_NORMAL);
        }

        if (rv == KERN_SUCCESS)
                return (0);
nogo:
        if (!usermode) {
                if (td->td_gd->gd_intr_nesting_level == 0 &&
                    td->td_pcb->pcb_onfault) {
                        frame->tf_rip = (register_t)td->td_pcb->pcb_onfault;
                        return (0);
                }
                trap_fatal(frame, frame->tf_addr);
                return (-1);
        }

        /*
         * NOTE: on amd64 we have a tf_addr field in the trapframe, no
         * kludge is needed to pass the fault address to signal handlers.
         */
        struct proc *p = td->td_proc;
        kprintf("seg-fault accessing address %p rip=%p pid=%d p_comm=%s\n",
                (void *)va, (void *)frame->tf_rip, p->p_pid, p->p_comm);
        /* Debugger("seg-fault"); */

        return((rv == KERN_PROTECTION_FAILURE) ? SIGBUS : SIGSEGV);
}

static void
trap_fatal(struct trapframe *frame, vm_offset_t eva)
{
        int code, ss;
        u_int type;
        long rsp;
        struct soft_segment_descriptor softseg;
        char *msg;

        code = frame->tf_err;
        type = frame->tf_trapno;
        sdtossd(&gdt[IDXSEL(frame->tf_cs & 0xffff)], &softseg);

        if (type <= MAX_TRAP_MSG)
                msg = trap_msg[type];
        else
                msg = "UNKNOWN";
        kprintf("\n\nFatal trap %d: %s while in %s mode\n", type, msg,
            ISPL(frame->tf_cs) == SEL_UPL ? "user" : "kernel");
#ifdef SMP
        /* three separate prints in case of a trap on an unmapped page */
        kprintf("mp_lock = %08x; ", mp_lock);
        kprintf("cpuid = %d; ", mycpu->gd_cpuid);
        kprintf("lapic->id = %08x\n", lapic->id);
#endif
        if (type == T_PAGEFLT) {
                kprintf("fault virtual address  = 0x%lx\n", eva);
                kprintf("fault code             = %s %s %s, %s\n",
                        code & PGEX_U ? "user" : "supervisor",
                        code & PGEX_W ? "write" : "read",
                        code & PGEX_I ? "instruction" : "data",
                        code & PGEX_P ? "protection violation" : "page not present");
        }
        kprintf("instruction pointer    = 0x%lx:0x%lx\n",
               frame->tf_cs & 0xffff, frame->tf_rip);
        if (ISPL(frame->tf_cs) == SEL_UPL) {
                ss = frame->tf_ss & 0xffff;
                rsp = frame->tf_rsp;
        } else {
                ss = GSEL(GDATA_SEL, SEL_KPL);
                rsp = (long)&frame->tf_rsp;
        }
        kprintf("stack pointer          = 0x%x:0x%lx\n", ss, rsp);
        kprintf("frame pointer          = 0x%x:0x%lx\n", ss, frame->tf_rbp);
        kprintf("code segment           = base 0x%lx, limit 0x%lx, type 0x%x\n",
               softseg.ssd_base, softseg.ssd_limit, softseg.ssd_type);
        kprintf("                       = DPL %d, pres %d, long %d, def32 %d, gran %d\n",
               softseg.ssd_dpl, softseg.ssd_p, softseg.ssd_long, softseg.ssd_def32,
               softseg.ssd_gran);
        kprintf("processor eflags       = ");
        if (frame->tf_rflags & PSL_T)
                kprintf("trace trap, ");
        if (frame->tf_rflags & PSL_I)
                kprintf("interrupt enabled, ");
        if (frame->tf_rflags & PSL_NT)
                kprintf("nested task, ");
        if (frame->tf_rflags & PSL_RF)
                kprintf("resume, ");
        kprintf("IOPL = %ld\n", (frame->tf_rflags & PSL_IOPL) >> 12);
        kprintf("current process                = ");
        if (curproc) {
                kprintf("%lu\n",
                    (u_long)curproc->p_pid);
        } else {
                kprintf("Idle\n");
        }
        kprintf("current thread          = pri %d ", curthread->td_pri);
        if (curthread->td_pri >= TDPRI_CRIT)
                kprintf("(CRIT)");
        kprintf("\n");

#ifdef DDB
        if ((debugger_on_panic || db_active) && kdb_trap(type, code, frame))
                return;
#endif
        kprintf("trap number            = %d\n", type);
        if (type <= MAX_TRAP_MSG)
                panic("%s", trap_msg[type]);
        else
                panic("unknown/reserved trap");
}

/*
 * Double fault handler. Called when a fault occurs while writing
 * a frame for a trap/exception onto the stack. This usually occurs
 * when the stack overflows (such is the case with infinite recursion,
 * for example).
 */
void
dblfault_handler(struct trapframe *frame)
{
        kprintf0("DOUBLE FAULT\n");
        kprintf("\nFatal double fault\n");
        kprintf("rip = 0x%lx\n", frame->tf_rip);
        kprintf("rsp = 0x%lx\n", frame->tf_rsp);
        kprintf("rbp = 0x%lx\n", frame->tf_rbp);
#ifdef SMP
        /* three separate prints in case of a trap on an unmapped page */
        kprintf("mp_lock = %08x; ", mp_lock);
        kprintf("cpuid = %d; ", mycpu->gd_cpuid);
        kprintf("lapic->id = %08x\n", lapic->id);
#endif
        panic("double fault");
}

/*
 *      syscall2 -      MP aware system call request C handler
 *
 *      A system call is essentially treated as a trap except that the
 *      MP lock is not held on entry or return.  We are responsible for
 *      obtaining the MP lock if necessary and for handling ASTs
 *      (e.g. a task switch) prior to return.
 *
 *      In general, only simple access and manipulation of curproc and
 *      the current stack is allowed without having to hold MP lock.
 *
 *      MPSAFE - note that large sections of this routine are run without
 *               the MP lock.
 */
void
syscall2(struct trapframe *frame)
{
        struct thread *td = curthread;
        struct proc *p = td->td_proc;
        struct lwp *lp = td->td_lwp;
        caddr_t params;
        struct sysent *callp;
        register_t orig_tf_rflags;
        int sticks;
        int error;
        int narg;
#ifdef INVARIANTS
        int crit_count = td->td_pri & ~TDPRI_MASK;
#endif
#ifdef SMP
        int have_mplock = 0;
#endif
        register_t *argp;
        u_int code;
        int reg, regcnt;
        union sysunion args;
        register_t *argsdst;

        mycpu->gd_cnt.v_syscall++;

#ifdef DIAGNOSTIC
        if (ISPL(frame->tf_cs) != SEL_UPL) {
                get_mplock();
                panic("syscall");
                /* NOT REACHED */
        }
#endif

        KTR_LOG(kernentry_syscall, p->p_pid, lp->lwp_tid,
                frame->tf_eax);

#ifdef SMP
        KASSERT(td->td_mpcount == 0, ("badmpcount syscall2 from %p", (void *)frame->tf_rip));
        if (syscall_mpsafe == 0)
                MAKEMPSAFE(have_mplock);
#endif
        userenter(td);          /* lazy raise our priority */

        reg = 0;
        regcnt = 6;
        /*
         * Misc
         */
        sticks = (int)td->td_sticks;
        orig_tf_rflags = frame->tf_rflags;

        /*
         * Virtual kernel intercept - if a VM context managed by a virtual
         * kernel issues a system call the virtual kernel handles it, not us.
         * Restore the virtual kernel context and return from its system
         * call.  The current frame is copied out to the virtual kernel.
         */
        if (lp->lwp_vkernel && lp->lwp_vkernel->ve) {
                error = vkernel_trap(lp, frame);
                frame->tf_rax = error;
                if (error)
                        frame->tf_rflags |= PSL_C;
                error = EJUSTRETURN;
                goto out;
        }

        /*
         * Get the system call parameters and account for time
         */
        lp->lwp_md.md_regs = frame;
        params = (caddr_t)frame->tf_rsp + sizeof(register_t);
        code = frame->tf_rax;

        if (p->p_sysent->sv_prepsyscall) {
                (*p->p_sysent->sv_prepsyscall)(
                        frame, (int *)(&args.nosys.sysmsg + 1),
                        &code, &params);
        } else {
                if (code == SYS_syscall || code == SYS___syscall) {
                        code = frame->tf_rdi;
                        reg++;
                        regcnt--;
                }
        }

        if (p->p_sysent->sv_mask)
                code &= p->p_sysent->sv_mask;

        if (code >= p->p_sysent->sv_size)
                callp = &p->p_sysent->sv_table[0];
        else
                callp = &p->p_sysent->sv_table[code];

        narg = callp->sy_narg & SYF_ARGMASK;

        /*
         * On amd64 we get up to six arguments in registers. The rest are
         * on the stack. The first six members of 'struct trapframe' happen
         * to be the registers used to pass arguments, in exactly the right
         * order.
         */
        argp = &frame->tf_rdi;
        argp += reg;
        argsdst = (register_t *)(&args.nosys.sysmsg + 1);
        /*
         * JG can we overflow the space pointed to by 'argsdst'
         * either with 'bcopy' or with 'copyin'?
         */
        bcopy(argp, argsdst, sizeof(register_t) * regcnt);
        /*
         * copyin is MP aware, but the tracing code is not
         */
        if (narg > regcnt) {
                KASSERT(params != NULL, ("copyin args with no params!"));
                error = copyin(params, &argsdst[regcnt],
                        (narg - regcnt) * sizeof(register_t));
                if (error) {
#ifdef KTRACE
                        if (KTRPOINT(td, KTR_SYSCALL)) {
                                MAKEMPSAFE(have_mplock);
                                
                                ktrsyscall(lp, code, narg,
                                        (void *)(&args.nosys.sysmsg + 1));
                        }
#endif
                        goto bad;
                }
        }

#ifdef KTRACE
        if (KTRPOINT(td, KTR_SYSCALL)) {
                MAKEMPSAFE(have_mplock);
                ktrsyscall(lp, code, narg, (void *)(&args.nosys.sysmsg + 1));
        }
#endif

        /*
         * Default return value is 0 (will be copied to %rax).  Double-value
         * returns use %rax and %rdx.  %rdx is left unchanged for system
         * calls which return only one result.
         */
        args.sysmsg_fds[0] = 0;
        args.sysmsg_fds[1] = frame->tf_rdx;

        /*
         * The syscall might manipulate the trap frame. If it does it
         * will probably return EJUSTRETURN.
         */
        args.sysmsg_frame = frame;

        STOPEVENT(p, S_SCE, narg);      /* MP aware */

#ifdef SMP
        /*
         * Try to run the syscall without the MP lock if the syscall
         * is MP safe.  We have to obtain the MP lock no matter what if 
         * we are ktracing
         */
        if ((callp->sy_narg & SYF_MPSAFE) == 0)
                MAKEMPSAFE(have_mplock);
#endif

        error = (*callp->sy_call)(&args);

out:
        /*
         * MP SAFE (we may or may not have the MP lock at this point)
         */
        //kprintf("SYSMSG %d ", error);
        switch (error) {
        case 0:
                /*
                 * Reinitialize proc pointer `p' as it may be different
                 * if this is a child returning from fork syscall.
                 */
                p = curproc;
                lp = curthread->td_lwp;
                frame->tf_rax = args.sysmsg_fds[0];
                frame->tf_rdx = args.sysmsg_fds[1];
                frame->tf_rflags &= ~PSL_C;
                break;
        case ERESTART:
                /*
                 * Reconstruct pc, we know that 'syscall' is 2 bytes.
                 * We have to do a full context restore so that %r10
                 * (which was holding the value of %rcx) is restored for
                 * the next iteration.
                 */
                frame->tf_rip -= frame->tf_err;
                frame->tf_r10 = frame->tf_rcx;
                break;
        case EJUSTRETURN:
                break;
        case EASYNC:
                panic("Unexpected EASYNC return value (for now)");
        default:
bad:
                if (p->p_sysent->sv_errsize) {
                        if (error >= p->p_sysent->sv_errsize)
                                error = -1;     /* XXX */
                        else
                                error = p->p_sysent->sv_errtbl[error];
                }
                frame->tf_rax = error;
                frame->tf_rflags |= PSL_C;
                break;
        }

        /*
         * Traced syscall.  trapsignal() is not MP aware.
         */
        if (orig_tf_rflags & PSL_T) {
                MAKEMPSAFE(have_mplock);
                frame->tf_rflags &= ~PSL_T;
                trapsignal(lp, SIGTRAP, 0);
        }

        /*
         * Handle reschedule and other end-of-syscall issues
         */
        userret(lp, frame, sticks);

#ifdef KTRACE
        if (KTRPOINT(td, KTR_SYSRET)) {
                MAKEMPSAFE(have_mplock);
                ktrsysret(lp, code, error, args.sysmsg_result);
        }
#endif

        /*
         * This works because errno is findable through the
         * register set.  If we ever support an emulation where this
         * is not the case, this code will need to be revisited.
         */
        STOPEVENT(p, S_SCX, code);

        userexit(lp);
#ifdef SMP
        /*
         * Release the MP lock if we had to get it
         */
        KASSERT(td->td_mpcount == have_mplock, 
                ("badmpcount syscall2/end from %p", (void *)frame->tf_rip));
        if (have_mplock)
                rel_mplock();
#endif
        KTR_LOG(kernentry_syscall_ret, p->p_pid, lp->lwp_tid, error);
#ifdef INVARIANTS
        KASSERT(crit_count == (td->td_pri & ~TDPRI_MASK), 
                ("syscall: critical section count mismatch! %d/%d",
                crit_count / TDPRI_CRIT, td->td_pri / TDPRI_CRIT));
#endif
}

void
fork_return(struct lwp *lp, struct trapframe *frame)
{
        frame->tf_rax = 0;              /* Child returns zero */
        frame->tf_rflags &= ~PSL_C;     /* success */
        frame->tf_rdx = 1;

        generic_lwp_return(lp, frame);
        KTR_LOG(kernentry_fork_ret, lp->lwp_proc->p_pid, lp->lwp_tid);
}

/*
 * Simplified back end of syscall(), used when returning from fork()
 * directly into user mode.  MP lock is held on entry and should be
 * released on return.  This code will return back into the fork
 * trampoline code which then runs doreti.
 */
void
generic_lwp_return(struct lwp *lp, struct trapframe *frame)
{
        struct proc *p = lp->lwp_proc;

        /*
         * Newly forked processes are given a kernel priority.  We have to
         * adjust the priority to a normal user priority and fake entry
         * into the kernel (call userenter()) to install a passive release
         * function just in case userret() decides to stop the process.  This
         * can occur when ^Z races a fork.  If we do not install the passive
         * release function the current process designation will not be
         * released when the thread goes to sleep.
         */
        lwkt_setpri_self(TDPRI_USER_NORM);
        userenter(lp->lwp_thread);
        userret(lp, frame, 0);
#ifdef KTRACE
        if (KTRPOINT(lp->lwp_thread, KTR_SYSRET))
                ktrsysret(lp, SYS_fork, 0, 0);
#endif
        p->p_flag |= P_PASSIVE_ACQ;
        userexit(lp);
        p->p_flag &= ~P_PASSIVE_ACQ;
#ifdef SMP
        KKASSERT(lp->lwp_thread->td_mpcount == 1);
        rel_mplock();
#endif
}

/*
 * If PGEX_FPFAULT is set then set FP_VIRTFP in the PCB to force a T_DNA
 * fault (which is then passed back to the virtual kernel) if an attempt is
 * made to use the FP unit.
 *
 * XXX this is a fairly big hack.
 */
void
set_vkernel_fp(struct trapframe *frame)
{
        /* JGXXX */
}