#if defined(__ppc__) || defined(__ppc64__)
#include <architecture/ppc/cframe.h>
#elif defined(__arm__)
#include <architecture/arm/cframe.h>
#endif
#include "pthread_internals.h"
void
_pthread_setup(pthread_t thread,
void (*routine)(pthread_t),
void *vsp, int suspended,
int needresume)
{
kern_return_t r;
unsigned int count;
#if defined(__ppc__) || defined(__ppc64__)
#if defined(__ppc__)
ppc_thread_state_t state = {0};
ppc_thread_state_t *ts = &state;
thread_state_flavor_t flavor = PPC_THREAD_STATE;
count = PPC_THREAD_STATE_COUNT;
#elif defined(__ppc64__)
ppc_thread_state64_t state = {0};
ppc_thread_state64_t *ts = &state;
thread_state_flavor_t flavor = PPC_THREAD_STATE64;
count = PPC_THREAD_STATE64_COUNT;
#endif
if (suspended) {
PTHREAD_MACH_CALL(thread_get_state(thread->kernel_thread,
flavor,
(thread_state_t) &state,
&count),
r);
}
ts->srr0 = (uintptr_t)routine;
ts->r1 = (uintptr_t)vsp - C_ARGSAVE_LEN - C_RED_ZONE;
ts->r3 = (uintptr_t)thread;
if (suspended) {
PTHREAD_MACH_CALL(thread_set_state(thread->kernel_thread,
flavor,
(thread_state_t) &state,
count),
r);
if (needresume)
PTHREAD_MACH_CALL(thread_resume(thread->kernel_thread),
r);
} else {
PTHREAD_MACH_CALL(thread_create_running(mach_task_self(),
flavor,
(thread_state_t) ts,
count,
&thread->kernel_thread),
r);
}
#elif defined(__i386__)
i386_thread_state_t state = {0};
i386_thread_state_t *ts = &state;
int *sp = vsp;
count = i386_THREAD_STATE_COUNT;
if (suspended) {
PTHREAD_MACH_CALL(thread_get_state(thread->kernel_thread,
i386_THREAD_STATE,
(thread_state_t) &state,
&count),
r);
}
ts->eip = (int) routine;
sp -= 3;
*--sp = (int) thread;
*--sp = 0;
ts->esp = (int) sp;
if (suspended) {
PTHREAD_MACH_CALL(thread_set_state(thread->kernel_thread,
i386_THREAD_STATE,
(thread_state_t) &state,
i386_THREAD_STATE_COUNT),
r);
if (needresume)
PTHREAD_MACH_CALL(thread_resume(thread->kernel_thread),
r);
} else {
PTHREAD_MACH_CALL(thread_create_running(mach_task_self(),
i386_THREAD_STATE,
(thread_state_t) ts,
i386_THREAD_STATE_COUNT,
&thread->kernel_thread),
r);
}
#elif defined(__x86_64__)
x86_thread_state64_t state = {0};
x86_thread_state64_t *ts = &state;
uintptr_t *sp = vsp;
count = x86_THREAD_STATE64_COUNT;
if (suspended) {
PTHREAD_MACH_CALL(thread_get_state(thread->kernel_thread,
x86_THREAD_STATE64,
(thread_state_t) &state,
&count),
r);
}
ts->rip = (uintptr_t) routine;
ts->rdi = (uintptr_t) thread;
*--sp = 0;
ts->rsp = (uintptr_t) sp;
if (suspended) {
PTHREAD_MACH_CALL(thread_set_state(thread->kernel_thread,
x86_THREAD_STATE64,
(thread_state_t) &state,
x86_THREAD_STATE64_COUNT),
r);
if (needresume)
PTHREAD_MACH_CALL(thread_resume(thread->kernel_thread),
r);
} else {
PTHREAD_MACH_CALL(thread_create_running(mach_task_self(),
x86_THREAD_STATE64,
(thread_state_t) ts,
x86_THREAD_STATE64_COUNT,
&thread->kernel_thread),
r);
}
#elif defined(__arm__)
arm_thread_state_t state = {0};
arm_thread_state_t *ts = &state;
thread_state_flavor_t flavor = ARM_THREAD_STATE;
count = ARM_THREAD_STATE_COUNT;
if (suspended) {
PTHREAD_MACH_CALL(thread_get_state(thread->kernel_thread,
flavor,
(thread_state_t) &state,
&count),
r);
}
ts->pc = (uintptr_t)routine;
if (ts->pc & 1) {
ts->pc &= ~1;
ts->cpsr |= 0x20;
}
ts->sp = (uintptr_t)vsp - C_ARGSAVE_LEN - C_RED_ZONE;
ts->r[0] = (uintptr_t)thread;
if (suspended) {
PTHREAD_MACH_CALL(thread_set_state(thread->kernel_thread,
flavor,
(thread_state_t) &state,
count),
r);
if (needresume)
PTHREAD_MACH_CALL(thread_resume(thread->kernel_thread),
r);
} else {
PTHREAD_MACH_CALL(thread_create_running(mach_task_self(),
flavor,
(thread_state_t) ts,
count,
&thread->kernel_thread),
r);
}
#else
#error _pthread_setup not defined for this architecture
#endif
}