Module Name: src
Committed By: reinoud
Date: Sat Jan 7 20:07:01 UTC 2012
Modified Files:
src/sys/arch/usermode/conf: Makefile.usermode
Added Files:
src/sys/arch/usermode/target/amd64: cpu_amd64.c
src/sys/arch/usermode/target/i386: cpu_i386.c
Removed Files:
src/sys/arch/usermode/usermode: machdep.i386.c
Log Message:
Add AMD64 target for NetBSD/usermode next to i386 and reorganize source tree
to have port specific stuff in arch/usermode/target/<port>/
To generate a diff of this commit:
cvs rdiff -u -r1.29 -r1.30 src/sys/arch/usermode/conf/Makefile.usermode
cvs rdiff -u -r0 -r1.1 src/sys/arch/usermode/target/amd64/cpu_amd64.c
cvs rdiff -u -r0 -r1.1 src/sys/arch/usermode/target/i386/cpu_i386.c
cvs rdiff -u -r1.1 -r0 src/sys/arch/usermode/usermode/machdep.i386.c
Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.
Modified files:
Index: src/sys/arch/usermode/conf/Makefile.usermode
diff -u src/sys/arch/usermode/conf/Makefile.usermode:1.29 src/sys/arch/usermode/conf/Makefile.usermode:1.30
--- src/sys/arch/usermode/conf/Makefile.usermode:1.29 Fri Jan 6 20:44:57 2012
+++ src/sys/arch/usermode/conf/Makefile.usermode Sat Jan 7 20:07:00 2012
@@ -1,4 +1,4 @@
-# $NetBSD: Makefile.usermode,v 1.29 2012/01/06 20:44:57 reinoud Exp $
+# $NetBSD: Makefile.usermode,v 1.30 2012/01/07 20:07:00 reinoud Exp $
OPT_CPU_HOST= %CPU_HOST%
.if !empty(OPT_CPU_HOST)
@@ -53,8 +53,8 @@ MD_OBJS= thunk.o
MD_CFILES= ${USERMODE}/usermode/thunk.c
MD_SFILES=
-MD_OBJS+= machdep.${USERMODE_CPU}.o
-MD_CFILES+= ${USERMODE}/usermode/machdep.${USERMODE_CPU}.c
+MD_OBJS+= cpu_${USERMODE_CPU}.o
+MD_CFILES+= ${USERMODE}/target/${USERMODE_CPU}/cpu_${USERMODE_CPU}.c
##
## (5) link settings
Added files:
Index: src/sys/arch/usermode/target/amd64/cpu_amd64.c
diff -u /dev/null src/sys/arch/usermode/target/amd64/cpu_amd64.c:1.1
--- /dev/null Sat Jan 7 20:07:01 2012
+++ src/sys/arch/usermode/target/amd64/cpu_amd64.c Sat Jan 7 20:07:00 2012
@@ -0,0 +1,351 @@
+/* $NetBSD: cpu_amd64.c,v 1.1 2012/01/07 20:07:00 reinoud Exp $ */
+
+/*-
+ * Copyright (c) 2011 Reinoud Zandijk <[email protected]>
+ * Copyright (c) 2007 Jared D. McNeill <[email protected]>
+ * All rights reserved.
+ *
+ * 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.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. 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 FOUNDATION 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.
+ */
+
+/*
+ * Note that this machdep.c uses the `dummy' mcontext_t defined for usermode.
+ * This is basicly a blob of PAGE_SIZE big. We might want to switch over to
+ * non-generic mcontext_t's one day, but will this break non-NetBSD hosts?
+ */
+
+
+#include <sys/cdefs.h>
+__KERNEL_RCSID(0, "$NetBSD: cpu_amd64.c,v 1.1 2012/01/07 20:07:00 reinoud Exp $");
+
+#include <sys/types.h>
+#include <sys/systm.h>
+#include <sys/param.h>
+#include <sys/time.h>
+#include <sys/exec.h>
+#include <sys/buf.h>
+#include <sys/boot_flag.h>
+#include <sys/ucontext.h>
+#include <sys/utsname.h>
+#include <machine/pcb.h>
+#include <machine/psl.h>
+
+#include <uvm/uvm_extern.h>
+#include <uvm/uvm_page.h>
+
+#include <dev/mm.h>
+#include <machine/machdep.h>
+#include <machine/thunk.h>
+
+
+#if 0
+static void dump_regs(register_t *reg);;
+
+static void
+dump_regs(register_t *reg)
+{
+ int i;
+
+ /* register dump before call */
+ const char *name[] = {"RDI", "RSI", "RDX", "RCX", "R8", "R9", "R10",
+ "R11", "R12", "R13", "R14", "R15", "RBP", "RAX",
+ "GS", "FS", "ES", "DS", "TRAPNO", "ERR", "RIP", "CS",
+ "RFLAGS", "RSP", "SS"};
+
+ for (i =0; i < 26; i++)
+ printf("reg[%02d] (%6s) = %"PRIx32"\n",
+ i, name[i], (uint32_t) reg[i]);
+}
+#endif
+
+
+/* from sys/arch/amd64/include/frame.h : KEEP IN SYNC */
+
+/*
+ * Signal frame
+ */
+struct sigframe_siginfo {
+ uint64_t sf_ra; /* return address for handler */
+ siginfo_t sf_si; /* actual saved siginfo */
+ ucontext_t sf_uc; /* actual saved ucontext */
+};
+
+
+/* should be the same as i386 */
+/*
+ * mcontext extensions to handle signal delivery.
+ */
+#define _UC_SETSTACK 0x00010000
+#define _UC_CLRSTACK 0x00020000
+#define _UC_VM 0x00040000
+#define _UC_TLSBASE 0x00080000
+
+
+void
+sendsig_siginfo(const ksiginfo_t *ksi, const sigset_t *mask)
+{
+ struct lwp *l = curlwp;
+ struct proc *p = l->l_proc;
+ struct pcb *pcb = lwp_getpcb(l);
+ struct sigacts *ps = p->p_sigacts;
+ struct sigframe_siginfo *fp, frame;
+ int sig = ksi->ksi_signo;
+ sig_t catcher = SIGACTION(p, sig).sa_handler;
+ ucontext_t *ucp = &pcb->pcb_userret_ucp;
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+ int onstack, error;
+ char *sp;
+
+ KASSERT(mutex_owned(p->p_lock));
+
+#if 0
+ thunk_printf("%s: ", __func__);
+ thunk_printf("flags %d, ", (int) ksi->ksi_flags);
+ thunk_printf("to lwp %d, signo %d, code %d, errno %d\n",
+ (int) ksi->ksi_lid,
+ ksi->ksi_signo,
+ ksi->ksi_code,
+ ksi->ksi_errno);
+#endif
+
+ /* do we need to jump onto the signal stack? */
+ onstack = (l->l_sigstk.ss_flags & (SS_DISABLE | SS_ONSTACK)) == 0
+ && (SIGACTION(p, sig).sa_flags & SA_ONSTACK) != 0;
+
+ sp = ((char *) reg[24] - 128);/* why -128?*//* RSP */
+ if (onstack)
+ sp = (char *) l->l_sigstk.ss_sp + l->l_sigstk.ss_size;
+
+ sp -= sizeof(struct sigframe_siginfo);
+ /*
+ * Round down the stackpointer to a multiple of 16 for
+ * fxsave and the ABI
+ */
+ fp = (struct sigframe_siginfo *) (((unsigned long)sp & ~15) - 8);
+
+ /* set up stack frame */
+ frame.sf_ra = (uint64_t) ps->sa_sigdesc[sig].sd_tramp;
+ frame.sf_si._info = ksi->ksi_info;
+
+ /* copy our userret context into sf_uc */
+ memcpy(&frame.sf_uc, ucp, sizeof(ucontext_t));
+ frame.sf_uc.uc_sigmask = *mask;
+ frame.sf_uc.uc_link = l->l_ctxlink;
+ frame.sf_uc.uc_flags |= (l->l_sigstk.ss_flags & SS_ONSTACK)
+ ? _UC_SETSTACK : _UC_CLRSTACK;
+ memset(&frame.sf_uc.uc_stack, 0, sizeof(frame.sf_uc.uc_stack));
+ sendsig_reset(l, sig);
+
+ /* copyout our frame to the stackframe */
+ mutex_exit(p->p_lock);
+ error = copyout(&frame, fp, sizeof(frame));
+ mutex_enter(p->p_lock);
+
+ if (error != 0) {
+ /*
+ * Process has trashed its stack; give it an illegal
+ * instruction to halt it in its tracks.
+ */
+ sigexit(l, SIGILL);
+ /* NOTREACHED */
+ }
+
+ /* set catcher and the new stack pointer */
+ reg[24] = (register_t) fp; /* RSP */
+ reg[21] = (register_t) catcher; /* RIP */
+
+ reg[ 0] = sig; /* RDI */
+ reg[ 1] = (uint64_t) &fp->sf_si; /* RSI */
+ reg[ 2] = (uint64_t) &fp->sf_uc; /* RDX */
+ reg[11] = reg[ 2]; /* R15 = RDX */
+
+ /* Remember that we're now on the signal stack. */
+ if (onstack)
+ l->l_sigstk.ss_flags |= SS_ONSTACK;
+}
+
+void
+setregs(struct lwp *l, struct exec_package *pack, vaddr_t stack)
+{
+ struct pcb *pcb = lwp_getpcb(l);
+ ucontext_t *ucp = &pcb->pcb_userret_ucp;
+ register_t *reg;
+ int i;
+
+ reg = (register_t *) &ucp->uc_mcontext;
+ for (i = 0; i < 15; i++)
+ reg[i] = 0;
+
+ reg[13] = l->l_proc->p_psstrp; /* RBX */
+ reg[21] = pack->ep_entry; /* RIP */
+ reg[24] = (register_t) stack; /* RSP */
+
+ ucp->uc_stack.ss_sp = (void *) stack;
+ ucp->uc_stack.ss_size = pack->ep_ssize;
+
+ //dump_regs(reg);
+}
+
+void
+md_syscall_get_syscallnumber(ucontext_t *ucp, uint32_t *code)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+ *code = reg[14]; /* RAX */
+}
+
+int
+md_syscall_getargs(lwp_t *l, ucontext_t *ucp, int nargs, int argsize,
+ register_t *args)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+ register_t *sp = (register_t *) reg[24];/* RSP */
+ int ret;
+
+ //dump_regs(reg);
+
+ /*
+ * 1st 6 syscall args are passed in
+ * rdi, rsi, rdx, r10, r8 and r9
+ */
+ args[0] = reg[ 0]; /* RDI */
+ args[1] = reg[ 1]; /* RSI */
+ args[2] = reg[ 2]; /* RDX */
+ args[3] = reg[ 6]; /* R10 (RCX got clobbered) */
+ args[4] = reg[ 4]; /* R8 */
+ args[5] = reg[ 5]; /* R9 */
+
+ ret = 0;
+ if (argsize > 6 * 8) {
+ ret = copyin(sp + 1,
+ args + 6, argsize - 6 * 8);
+ }
+
+ return ret;
+}
+
+void
+md_syscall_set_returnargs(lwp_t *l, ucontext_t *ucp,
+ int error, register_t *rval)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+
+ reg[23] &= ~PSL_C; /* RFLAGS */
+ if (error > 0) {
+ rval[0] = error;
+ reg[23] |= PSL_C; /* RFLAGS */
+ }
+
+ /* set return parameters */
+ reg[14] = rval[0]; /* RAX */
+ if (error == 0)
+ reg[ 2] = rval[1]; /* RDX */
+
+ //dump_regs(reg);
+}
+
+register_t
+md_get_pc(ucontext_t *ucp)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+
+ return reg[21]; /* RIP */
+}
+
+int
+md_syscall_check_opcode(ucontext_t *ucp)
+{
+ uint32_t opcode;
+
+ md_syscall_get_opcode(ucp, &opcode);
+
+ switch (opcode) {
+ case 0xff0f: /* UD1 */
+ case 0xff0b: /* UD2 */
+ case 0x80cd: /* int $80 */
+ case 0x340f: /* sysenter */
+ case 0x050f: /* syscall */
+ return 1;
+ default:
+ return 0;
+ }
+}
+
+
+void
+md_syscall_get_opcode(ucontext_t *ucp, uint32_t *opcode)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+// uint8_t *p8 = (uint8_t *) (reg[21]);
+ uint16_t *p16 = (uint16_t*) (reg[21]); /* RIP */
+
+ switch (*p16) {
+ case 0xff0f: /* UD1 */
+ case 0xff0b: /* UD2 */
+ case 0x80cd: /* int $80 */
+ case 0x340f: /* sysenter */
+ case 0x050f: /* syscall */
+ *opcode = *p16;
+ break;
+ default:
+ *opcode = 0;
+ }
+}
+
+void
+md_syscall_inc_pc(ucontext_t *ucp, uint32_t opcode)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+
+ /* advance program counter */
+ switch (opcode) {
+ case 0xff0f: /* UD1 */
+ case 0xff0b: /* UD2 */
+ case 0x80cd: /* int $80 */
+ case 0x340f: /* sysenter */
+ case 0x050f: /* syscall */
+ reg[21] += 2; /* RIP */
+ break;
+ default:
+ panic("%s, unknown illegal instruction: opcode = %x\n",
+ __func__, (uint32_t) opcode);
+ }
+}
+
+void
+md_syscall_dec_pc(ucontext_t *ucp, uint32_t opcode)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+
+ switch (opcode) {
+ case 0xff0f: /* UD1 */
+ case 0xff0b: /* UD2 */
+ case 0x80cd: /* int $80 */
+ case 0x340f: /* sysenter */
+ case 0x050f: /* syscall */
+ reg[21] -= 2; /* RIP */
+ break;
+ default:
+ panic("%s, unknown illegal instruction: opcode = %x\n",
+ __func__, (uint32_t) opcode);
+ }
+}
+
Index: src/sys/arch/usermode/target/i386/cpu_i386.c
diff -u /dev/null src/sys/arch/usermode/target/i386/cpu_i386.c:1.1
--- /dev/null Sat Jan 7 20:07:01 2012
+++ src/sys/arch/usermode/target/i386/cpu_i386.c Sat Jan 7 20:07:01 2012
@@ -0,0 +1,354 @@
+/* $NetBSD: cpu_i386.c,v 1.1 2012/01/07 20:07:01 reinoud Exp $ */
+
+/*-
+ * Copyright (c) 2011 Reinoud Zandijk <[email protected]>
+ * Copyright (c) 2007 Jared D. McNeill <[email protected]>
+ * All rights reserved.
+ *
+ * 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.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. 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 FOUNDATION 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.
+ */
+
+/*
+ * Note that this machdep.c uses the `dummy' mcontext_t defined for usermode.
+ * This is basicly a blob of PAGE_SIZE big. We might want to switch over to
+ * non-generic mcontext_t's one day, but will this break non-NetBSD hosts?
+ */
+
+#include <sys/cdefs.h>
+__KERNEL_RCSID(0, "$NetBSD: cpu_i386.c,v 1.1 2012/01/07 20:07:01 reinoud Exp $");
+
+#include <sys/types.h>
+#include <sys/systm.h>
+#include <sys/param.h>
+#include <sys/time.h>
+#include <sys/exec.h>
+#include <sys/buf.h>
+#include <sys/boot_flag.h>
+#include <sys/ucontext.h>
+#include <sys/utsname.h>
+#include <machine/pcb.h>
+#include <machine/psl.h>
+
+#include <uvm/uvm_extern.h>
+#include <uvm/uvm_page.h>
+
+#include <dev/mm.h>
+#include <machine/machdep.h>
+#include <machine/thunk.h>
+
+#if 0
+static void dump_regs(register_t *reg);;
+
+static void
+dump_regs(register_t *reg)
+{
+ int i;
+
+ /* register dump before call */
+ const char *name[] = {"GS", "FS", "ES", "DS", "EDI", "ESI", "EBP", "ESP",
+ "EBX", "EDX", "ECX", "EAX", "TRAPNO", "ERR", "EIP", "CS", "EFL",
+ "UESP", "SS"};
+
+ for (i =0; i < 19; i++)
+ printf("reg[%02d] (%6s) = %"PRIx32"\n", i, name[i], (uint32_t) reg[i]);
+}
+#endif
+
+
+/* from sys/arch/i386/include/frame.h : KEEP IN SYNC */
+
+/*
+ * New-style signal frame
+ */
+struct sigframe_siginfo {
+ int sf_ra; /* return address for handler */
+ int sf_signum; /* "signum" argument for handler */
+ siginfo_t *sf_sip; /* "sip" argument for handler */
+ ucontext_t *sf_ucp; /* "ucp" argument for handler */
+ siginfo_t sf_si; /* actual saved siginfo */
+ ucontext_t sf_uc; /* actual saved ucontext */
+};
+
+
+/*
+ * mcontext extensions to handle signal delivery.
+ */
+#define _UC_SETSTACK 0x00010000
+#define _UC_CLRSTACK 0x00020000
+#define _UC_VM 0x00040000
+#define _UC_TLSBASE 0x00080000
+
+
+void
+sendsig_siginfo(const ksiginfo_t *ksi, const sigset_t *mask)
+{
+ struct lwp *l = curlwp;
+ struct proc *p = l->l_proc;
+ struct pcb *pcb = lwp_getpcb(l);
+ struct sigacts *ps = p->p_sigacts;
+ struct sigframe_siginfo *fp, frame;
+ int sig = ksi->ksi_signo;
+ sig_t catcher = SIGACTION(p, sig).sa_handler;
+ ucontext_t *ucp = &pcb->pcb_userret_ucp;
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+ int onstack, error;
+
+ KASSERT(mutex_owned(p->p_lock));
+
+#if 0
+ printf("%s: ", __func__);
+ printf("flags %d, ", (int) ksi->ksi_flags);
+ printf("to lwp %d, signo %d, code %d, errno %d\n",
+ (int) ksi->ksi_lid,
+ ksi->ksi_signo,
+ ksi->ksi_code,
+ ksi->ksi_errno);
+#endif
+
+ /* do we need to jump onto the signal stack? */
+ onstack = (l->l_sigstk.ss_flags & (SS_DISABLE | SS_ONSTACK)) == 0
+ && (SIGACTION(p, sig).sa_flags & SA_ONSTACK) != 0;
+
+ fp = (void *) reg[17]; /* ESP */
+ if (onstack)
+ fp = (void *)
+ ((char *) l->l_sigstk.ss_sp + l->l_sigstk.ss_size);
+
+ fp--;
+
+ /* set up stack frame */
+ frame.sf_ra = (int)ps->sa_sigdesc[sig].sd_tramp;
+ frame.sf_signum = sig;
+ frame.sf_sip = &fp->sf_si;
+ frame.sf_ucp = &fp->sf_uc;
+ frame.sf_si._info = ksi->ksi_info;
+
+ /* copy our userret context into sf_uc */
+ memcpy(&frame.sf_uc, ucp, sizeof(ucontext_t));
+ frame.sf_uc.uc_sigmask = *mask;
+ frame.sf_uc.uc_link = l->l_ctxlink; /* XXX ??? */
+ frame.sf_uc.uc_flags |= (l->l_sigstk.ss_flags & SS_ONSTACK)
+ ? _UC_SETSTACK : _UC_CLRSTACK;
+ memset(&frame.sf_uc.uc_stack, 0, sizeof(frame.sf_uc.uc_stack));
+
+ sendsig_reset(l, sig);
+
+ /* copyout our frame to the stackframe */
+ mutex_exit(p->p_lock);
+ error = copyout(&frame, fp, sizeof(frame));
+ mutex_enter(p->p_lock);
+
+ if (error != 0) {
+ /*
+ * Process has trashed its stack; give it an illegal
+ * instruction to halt it in its tracks.
+ */
+ sigexit(l, SIGILL);
+ /* NOTREACHED */
+ }
+
+ /* set catcher and the new stack pointer */
+ reg[17] = (register_t) fp; /* ESP */
+ reg[14] = (register_t) catcher; /* EIP */
+
+ /* Remember that we're now on the signal stack. */
+ if (onstack)
+ l->l_sigstk.ss_flags |= SS_ONSTACK;
+}
+
+void
+setregs(struct lwp *l, struct exec_package *pack, vaddr_t stack)
+{
+ struct pcb *pcb = lwp_getpcb(l);
+ ucontext_t *ucp = &pcb->pcb_userret_ucp;
+ uint *reg, i;
+
+#ifdef DEBUG_EXEC
+ printf("setregs called: lwp %p, exec package %p, stack %p\n",
+ l, pack, (void *) stack);
+ printf("current stat of pcb %p\n", pcb);
+ printf("\tpcb->pcb_ucp.uc_stack.ss_sp = %p\n",
+ pcb->pcb_ucp.uc_stack.ss_sp);
+ printf("\tpcb->pcb_ucp.uc_stack.ss_size = %d\n",
+ (int) pcb->pcb_ucp.uc_stack.ss_size);
+ printf("\tpcb->pcb_userret_ucp.uc_stack.ss_sp = %p\n",
+ pcb->pcb_userret_ucp.uc_stack.ss_sp);
+ printf("\tpcb->pcb_userret_ucp.uc_stack.ss_size = %d\n",
+ (int) pcb->pcb_userret_ucp.uc_stack.ss_size);
+#endif
+
+ reg = (int *) &ucp->uc_mcontext;
+ for (i = 4; i < 11; i++)
+ reg[i] = 0;
+
+ ucp->uc_stack.ss_sp = (void *) (stack-4); /* to prevent clearing */
+ ucp->uc_stack.ss_size = 0; //pack->ep_ssize;
+ thunk_makecontext(ucp, (void *) pack->ep_entry, 0, NULL, NULL, NULL);
+
+ /* patch up */
+ reg[ 8] = l->l_proc->p_psstrp; /* _REG_EBX */
+ reg[17] = (stack); /* _REG_UESP */
+
+ //dump_regs(reg);
+
+#ifdef DEBUG_EXEC
+ printf("updated pcb %p\n", pcb);
+ printf("\tpcb->pcb_ucp.uc_stack.ss_sp = %p\n",
+ pcb->pcb_ucp.uc_stack.ss_sp);
+ printf("\tpcb->pcb_ucp.uc_stack.ss_size = %d\n",
+ (int) pcb->pcb_ucp.uc_stack.ss_size);
+ printf("\tpcb->pcb_userret_ucp.uc_stack.ss_sp = %p\n",
+ pcb->pcb_userret_ucp.uc_stack.ss_sp);
+ printf("\tpcb->pcb_userret_ucp.uc_stack.ss_size = %d\n",
+ (int) pcb->pcb_userret_ucp.uc_stack.ss_size);
+ printf("\tpack->ep_entry = %p\n",
+ (void *) pack->ep_entry);
+#endif
+}
+
+void
+md_syscall_get_syscallnumber(ucontext_t *ucp, uint32_t *code)
+{
+ uint *reg = (int *) &ucp->uc_mcontext;
+ *code = reg[11]; /* EAX */
+}
+
+int
+md_syscall_getargs(lwp_t *l, ucontext_t *ucp, int nargs, int argsize,
+ register_t *args)
+{
+ uint *reg = (int *) &ucp->uc_mcontext;
+ register_t *sp = (register_t *) reg[17];/* ESP */
+ int ret;
+
+ //dump_regs(reg);
+ ret = copyin(sp + 1, args, argsize);
+
+ return ret;
+}
+
+void
+md_syscall_set_returnargs(lwp_t *l, ucontext_t *ucp,
+ int error, register_t *rval)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+
+ reg[16] &= ~PSL_C; /* EFL */
+ if (error > 0) {
+ rval[0] = error;
+ reg[16] |= PSL_C; /* EFL */
+ }
+
+ /* set return parameters */
+ reg[11] = rval[0]; /* EAX */
+ if (error == 0)
+ reg[ 9] = rval[1]; /* EDX */
+
+ //dump_regs(reg);
+}
+
+register_t
+md_get_pc(ucontext_t *ucp)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+
+ return reg[14]; /* EIP */
+}
+
+int
+md_syscall_check_opcode(ucontext_t *ucp)
+{
+ uint32_t opcode;
+
+ md_syscall_get_opcode(ucp, &opcode);
+
+ switch (opcode) {
+ case 0xff0f: /* UD1 */
+ case 0xff0b: /* UD2 */
+ case 0x80cd: /* int $80 */
+ case 0x340f: /* sysenter */
+ case 0x050f: /* syscall */
+ return 1;
+ default:
+ return 0;
+ }
+}
+
+void
+md_syscall_get_opcode(ucontext_t *ucp, uint32_t *opcode)
+{
+ register_t *reg = (register_t *) &ucp->uc_mcontext;
+// uint8_t *p8 = (uint8_t *) (reg[14]);
+ uint16_t *p16 = (uint16_t*) (reg[14]); /* EIP */
+
+ switch (*p16) {
+ case 0xff0f: /* UD1 */
+ case 0xff0b: /* UD2 */
+ case 0x80cd: /* int $80 */
+ case 0x340f: /* sysenter */
+ case 0x050f: /* syscall */
+ *opcode = *p16;
+ break;
+ default:
+ *opcode = 0;
+ }
+}
+
+void
+md_syscall_inc_pc(ucontext_t *ucp, uint32_t opcode)
+{
+ uint *reg = (int *) &ucp->uc_mcontext;
+
+ /* advance program counter */
+ switch (opcode) {
+ case 0xff0f: /* UD1 */
+ case 0xff0b: /* UD2 */
+ case 0x80cd: /* int $80 */
+ case 0x340f: /* sysenter */
+ case 0x050f: /* syscall */
+ reg[14] += 2; /* EIP */
+ break;
+ default:
+ panic("%s, unknown illegal instruction: opcode = %x\n",
+ __func__, (uint32_t) opcode);
+ }
+}
+
+void
+md_syscall_dec_pc(ucontext_t *ucp, uint32_t opcode)
+{
+ uint *reg = (int *) &ucp->uc_mcontext;
+
+ switch (opcode) {
+ case 0xff0f: /* UD1 */
+ case 0xff0b: /* UD2 */
+ case 0x80cd: /* int $80 */
+ case 0x340f: /* sysenter */
+ case 0x050f: /* syscall */
+ reg[14] -= 2; /* EIP */
+ break;
+ default:
+ panic("%s, unknown illegal instruction: opcode = %x\n",
+ __func__, (uint32_t) opcode);
+ }
+}
+
