#ifdef MACH_BSD
#include <cpus.h>
#include <mach_rt.h>
#include <mach_debug.h>
#include <mach_ldebug.h>
#include <mach/kern_return.h>
#include <mach/thread_status.h>
#include <mach/vm_param.h>
#include <kern/counters.h>
#include <kern/cpu_data.h>
#include <kern/mach_param.h>
#include <kern/task.h>
#include <kern/thread.h>
#include <kern/thread_swap.h>
#include <kern/sched_prim.h>
#include <kern/misc_protos.h>
#include <kern/assert.h>
#include <kern/spl.h>
#include <kern/syscall_sw.h>
#include <ipc/ipc_port.h>
#include <vm/vm_kern.h>
#include <vm/pmap.h>
#include <i386/thread.h>
#include <i386/eflags.h>
#include <i386/proc_reg.h>
#include <i386/seg.h>
#include <i386/tss.h>
#include <i386/user_ldt.h>
#include <i386/fpu.h>
#include <i386/iopb_entries.h>
#include <i386/machdep_call.h>
#include <sys/syscall.h>
#include <sys/ktrace.h>
struct proc;
kern_return_t
thread_userstack(
thread_t,
int,
thread_state_t,
unsigned int,
vm_offset_t *,
int *
);
kern_return_t
thread_entrypoint(
thread_t,
int,
thread_state_t,
unsigned int,
vm_offset_t *
);
struct i386_saved_state *
get_user_regs(
thread_act_t);
unsigned int get_msr_exportmask(void);
unsigned int get_msr_nbits(void);
unsigned int get_msr_rbits(void);
kern_return_t
thread_compose_cthread_desc(unsigned int addr, pcb_t pcb);
kern_return_t
thread_userstack(
thread_t thread,
int flavor,
thread_state_t tstate,
unsigned int count,
vm_offset_t *user_stack,
int *customstack
)
{
struct i386_saved_state *state;
i386_thread_state_t *state25;
vm_offset_t uesp;
if (customstack)
*customstack = 0;
switch (flavor) {
case i386_THREAD_STATE:
state25 = (i386_thread_state_t *) tstate;
if (state25->esp)
*user_stack = state25->esp;
if (customstack && state25->esp)
*customstack = 1;
else
*customstack = 0;
break;
case i386_NEW_THREAD_STATE:
if (count < i386_NEW_THREAD_STATE_COUNT)
return (KERN_INVALID_ARGUMENT);
else {
state = (struct i386_saved_state *) tstate;
uesp = state->uesp;
}
if (uesp)
*user_stack = uesp;
if (customstack && uesp)
*customstack = 1;
else
*customstack = 0;
break;
default :
return (KERN_INVALID_ARGUMENT);
}
return (KERN_SUCCESS);
}
kern_return_t
thread_entrypoint(
thread_t thread,
int flavor,
thread_state_t tstate,
unsigned int count,
vm_offset_t *entry_point
)
{
struct i386_saved_state *state;
i386_thread_state_t *state25;
if (*entry_point == 0)
*entry_point = VM_MIN_ADDRESS;
switch (flavor) {
case i386_THREAD_STATE:
state25 = (i386_thread_state_t *) tstate;
*entry_point = state25->eip ? state25->eip: VM_MIN_ADDRESS;
break;
case i386_NEW_THREAD_STATE:
if (count < i386_THREAD_STATE_COUNT)
return (KERN_INVALID_ARGUMENT);
else {
state = (struct i386_saved_state *) tstate;
*entry_point = state->eip ? state->eip: VM_MIN_ADDRESS;
}
break;
}
return (KERN_SUCCESS);
}
struct i386_saved_state *
get_user_regs(thread_act_t th)
{
if (th->mact.pcb)
return(USER_REGS(th));
else {
printf("[get_user_regs: thread does not have pcb]");
return NULL;
}
}
kern_return_t
machine_thread_dup(
thread_act_t parent,
thread_act_t child
)
{
struct i386_saved_state *parent_state, *child_state;
struct i386_machine_state *ims;
struct i386_float_state floatregs;
#ifdef XXX
if ((pcb_t)(per_proc_info[cpu_number()].fpu_pcb) == parent->mact.pcb) {
fp_state_save(parent);
}
#endif
if (child->mact.pcb == NULL || parent->mact.pcb == NULL)
return (KERN_FAILURE);
child->mact.pcb->iss = parent->mact.pcb->iss;
if (parent->mact.pcb->ims.ifps) {
if (fpu_get_state(parent, &floatregs) == KERN_SUCCESS)
fpu_set_state(child, &floatregs);
}
return (KERN_SUCCESS);
}
void thread_set_child(thread_act_t child, int pid);
void
thread_set_child(thread_act_t child, int pid)
{
child->mact.pcb->iss.eax = pid;
child->mact.pcb->iss.edx = 1;
child->mact.pcb->iss.efl &= ~EFL_CF;
}
void thread_set_parent(thread_act_t parent, int pid);
void
thread_set_parent(thread_act_t parent, int pid)
{
parent->mact.pcb->iss.eax = pid;
parent->mact.pcb->iss.edx = 0;
parent->mact.pcb->iss.efl &= ~EFL_CF;
}
void
pagemove(
register caddr_t from,
register caddr_t to,
int size)
{
pmap_movepage((unsigned long)from, (unsigned long)to, (vm_size_t)size);
}
#define ERESTART -1
#define EJUSTRETURN -2
struct sysent {
unsigned short sy_narg;
char sy_parallel;
char sy_funnel;
unsigned long (*sy_call)(void *, void *, int *);
};
#define NO_FUNNEL 0
#define KERNEL_FUNNEL 1
#define NETWORK_FUNNEL 2
extern funnel_t * kernel_flock;
extern funnel_t * network_flock;
extern struct sysent sysent[];
int set_bsduthreadargs (thread_act_t, struct i386_saved_state *, void *);
void * get_bsduthreadarg(thread_act_t);
void unix_syscall(struct i386_saved_state *);
void
unix_syscall_return(int error)
{
thread_act_t thread;
volatile int *rval;
struct i386_saved_state *regs;
struct proc *p;
struct proc *current_proc();
unsigned short code;
vm_offset_t params;
struct sysent *callp;
extern int nsysent;
thread = current_act();
rval = (int *)get_bsduthreadrval(thread);
p = current_proc();
regs = USER_REGS(thread);
code = regs->eax;
params = (vm_offset_t) ((caddr_t)regs->uesp + sizeof (int));
callp = (code >= nsysent) ? &sysent[63] : &sysent[code];
if (callp == sysent) {
code = fuword(params);
}
if (error == ERESTART) {
regs->eip -= 7;
}
else if (error != EJUSTRETURN) {
if (error) {
regs->eax = error;
regs->efl |= EFL_CF;
} else {
regs->eax = rval[0];
regs->edx = rval[1];
regs->efl &= ~EFL_CF;
}
}
ktrsysret(p, code, error, rval[0], callp->sy_funnel);
KERNEL_DEBUG_CONSTANT(BSDDBG_CODE(DBG_BSD_EXCP_SC, code) | DBG_FUNC_END,
error, rval[0], rval[1], 0, 0);
if (callp->sy_funnel != NO_FUNNEL)
(void) thread_funnel_set(current_thread()->funnel_lock, FALSE);
thread_exception_return();
}
void
unix_syscall(struct i386_saved_state *regs)
{
thread_act_t thread;
void *vt;
unsigned short code;
struct sysent *callp;
int nargs, error;
volatile int *rval;
int funnel_type;
vm_offset_t params;
extern int nsysent;
struct proc *p;
struct proc *current_proc();
thread = current_act();
p = current_proc();
rval = (int *)get_bsduthreadrval(thread);
code = regs->eax;
params = (vm_offset_t) ((caddr_t)regs->uesp + sizeof (int));
callp = (code >= nsysent) ? &sysent[63] : &sysent[code];
if (callp == sysent) {
code = fuword(params);
params += sizeof (int);
callp = (code >= nsysent) ? &sysent[63] : &sysent[code];
}
vt = get_bsduthreadarg(thread);
if ((nargs = (callp->sy_narg * sizeof (int))) &&
(error = copyin((char *) params, (char *)vt , nargs)) != 0) {
regs->eax = error;
regs->efl |= EFL_CF;
thread_exception_return();
}
rval[0] = 0;
rval[1] = regs->edx;
funnel_type = callp->sy_funnel;
if(funnel_type == KERNEL_FUNNEL)
(void) thread_funnel_set(kernel_flock, TRUE);
else if (funnel_type == NETWORK_FUNNEL)
(void) thread_funnel_set(network_flock, TRUE);
set_bsduthreadargs(thread, regs, NULL);
if (callp->sy_narg > 8)
panic("unix_syscall max arg count exceeded (%d)", callp->sy_narg);
ktrsyscall(p, code, callp->sy_narg, vt, funnel_type);
{
int *ip = (int *)vt;
KERNEL_DEBUG_CONSTANT(BSDDBG_CODE(DBG_BSD_EXCP_SC, code) | DBG_FUNC_START,
*ip, *(ip+1), *(ip+2), *(ip+3), 0);
}
error = (*(callp->sy_call))(p, (void *) vt, (int *) &rval[0]);
#if 0
regs = USER_REGS(thread);
#endif
if (error == ERESTART) {
regs->eip -= 7;
}
else if (error != EJUSTRETURN) {
if (error) {
regs->eax = error;
regs->efl |= EFL_CF;
} else {
regs->eax = rval[0];
regs->edx = rval[1];
regs->efl &= ~EFL_CF;
}
}
ktrsysret(p, code, error, rval[0], funnel_type);
KERNEL_DEBUG_CONSTANT(BSDDBG_CODE(DBG_BSD_EXCP_SC, code) | DBG_FUNC_END,
error, rval[0], rval[1], 0, 0);
if(funnel_type != NO_FUNNEL)
(void) thread_funnel_set(current_thread()->funnel_lock, FALSE);
thread_exception_return();
}
void
machdep_syscall( struct i386_saved_state *regs)
{
int trapno, nargs;
machdep_call_t *entry;
thread_t thread;
struct proc *p;
struct proc *current_proc();
trapno = regs->eax;
if (trapno < 0 || trapno >= machdep_call_count) {
regs->eax = (unsigned int)kern_invalid();
thread_exception_return();
}
entry = &machdep_call_table[trapno];
nargs = entry->nargs;
if (nargs > 0) {
int args[nargs];
if (copyin((char *) regs->uesp + sizeof (int),
(char *) args,
nargs * sizeof (int))) {
regs->eax = KERN_INVALID_ADDRESS;
thread_exception_return();
}
switch (nargs) {
case 1:
regs->eax = (*entry->routine)(args[0]);
break;
case 2:
regs->eax = (*entry->routine)(args[0],args[1]);
break;
case 3:
regs->eax = (*entry->routine)(args[0],args[1],args[2]);
break;
case 4:
regs->eax = (*entry->routine)(args[0],args[1],args[2],args[3]);
break;
default:
panic("machdep_syscall(): too many args");
}
}
else
regs->eax = (*entry->routine)();
if (current_thread()->funnel_lock)
(void) thread_funnel_set(current_thread()->funnel_lock, FALSE);
thread_exception_return();
}
kern_return_t
thread_compose_cthread_desc(unsigned int addr, pcb_t pcb)
{
struct real_descriptor desc;
extern struct fake_descriptor *mp_ldt[];
struct real_descriptor *ldtp;
int mycpu = cpu_number();
ldtp = (struct real_descriptor *)mp_ldt[mycpu];
desc.limit_low = 1;
desc.limit_high = 0;
desc.base_low = addr & 0xffff;
desc.base_med = (addr >> 16) & 0xff;
desc.base_high = (addr >> 24) & 0xff;
desc.access = ACC_P|ACC_PL_U|ACC_DATA_W;
desc.granularity = SZ_32|SZ_G;
pcb->cthread_desc = desc;
ldtp[sel_idx(USER_CTHREAD)] = desc;
return(KERN_SUCCESS);
}
kern_return_t
thread_set_cthread_self(int self)
{
current_act()->mact.pcb->cthread_self = (unsigned int)self;
return (KERN_SUCCESS);
}
kern_return_t
thread_get_cthread_self(void)
{
return ((kern_return_t)current_act()->mact.pcb->cthread_self);
}
kern_return_t
thread_fast_set_cthread_self(int self)
{
pcb_t pcb;
pcb = (pcb_t)current_act()->mact.pcb;
thread_compose_cthread_desc((unsigned int)self, pcb);
pcb->cthread_self = (unsigned int)self;
return (USER_CTHREAD);
}
void
mach25_syscall(struct i386_saved_state *regs)
{
printf("*** Atttempt to execute a Mach 2.5 system call at EIP=%x EAX=%x(%d)\n",
regs->eip, regs->eax, -regs->eax);
panic("FIXME!");
}
#endif
extern unsigned int mach_call_start(unsigned int, unsigned int *);
__private_extern__
unsigned int
mach_call_start(unsigned int call_number, unsigned int *args)
{
int i, argc;
unsigned int kdarg[3];
kdarg[0]=0;
kdarg[1]=0;
kdarg[2]=0;
argc = mach_trap_table[call_number>>4].mach_trap_arg_count;
if (argc > 3)
argc = 3;
for (i=0; i < argc; i++)
kdarg[i] = (int)*(args + i);
KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_EXCP_SC, (call_number>>4)) | DBG_FUNC_START,
kdarg[0], kdarg[1], kdarg[2], 0, 0);
return call_number;
}
extern unsigned int mach_call_end(unsigned int, unsigned int);
__private_extern__
unsigned int
mach_call_end(unsigned int call_number, unsigned int retval)
{
KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_EXCP_SC,(call_number>>4)) | DBG_FUNC_END,
retval, 0, 0, 0, 0);
return retval;
}