X-Git-Url: https://git.saurik.com/apple/libc.git/blobdiff_plain/5b2abdfbf4211b6592cdd02b9507555a0ecbb04b..a28bf75d63c6a64e4c3b417c6052e45f42c6cedd:/pthreads/thread_setup.c diff --git a/pthreads/thread_setup.c b/pthreads/thread_setup.c index 28c08f5..d2985df 100644 --- a/pthreads/thread_setup.c +++ b/pthreads/thread_setup.c @@ -1,3 +1,25 @@ +/* + * Copyright (c) 2000-2003, 2008 Apple Inc. All rights reserved. + * + * @APPLE_LICENSE_HEADER_START@ + * + * This file contains Original Code and/or Modifications of Original Code + * as defined in and that are subject to the Apple Public Source License + * Version 2.0 (the 'License'). You may not use this file except in + * compliance with the License. Please obtain a copy of the License at + * http://www.opensource.apple.com/apsl/ and read it before using this + * file. + * + * The Original Code and all software distributed under the License are + * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER + * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES, + * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY, + * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT. + * Please see the License for the specific language governing rights and + * limitations under the License. + * + * @APPLE_LICENSE_HEADER_END@ + */ /* * Copyright 1996 1995 by Open Software Foundation, Inc. 1997 1996 1995 1994 1993 1992 1991 * All Rights Reserved @@ -27,8 +49,10 @@ * Machine specific support for thread initialization */ -#if defined(__ppc__) +#if defined(__ppc__) || defined(__ppc64__) #include +#elif defined(__arm__) +#include #endif #include "pthread_internals.h" @@ -44,39 +68,46 @@ _pthread_setup(pthread_t thread, { kern_return_t r; unsigned int count; +#if defined(__ppc__) || defined(__ppc64__) #if defined(__ppc__) - struct ppc_thread_state state = {0}; - struct ppc_thread_state *ts = &state; - + 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 /* * Set up PowerPC registers. */ - count = PPC_THREAD_STATE_COUNT; if (suspended) { PTHREAD_MACH_CALL(thread_get_state(thread->kernel_thread, - PPC_THREAD_STATE, + flavor, (thread_state_t) &state, &count), r); } - ts->srr0 = (int) routine; + ts->srr0 = (uintptr_t)routine; ts->r1 = (uintptr_t)vsp - C_ARGSAVE_LEN - C_RED_ZONE; - ts->r3 = (int)thread; + ts->r3 = (uintptr_t)thread; /* Incase of needresume, suspend is always set */ if (suspended) { PTHREAD_MACH_CALL(thread_set_state(thread->kernel_thread, - PPC_THREAD_STATE, + flavor, (thread_state_t) &state, - PPC_THREAD_STATE_COUNT), + count), r); if (needresume) PTHREAD_MACH_CALL(thread_resume(thread->kernel_thread), r); } else { PTHREAD_MACH_CALL(thread_create_running(mach_task_self(), - PPC_THREAD_STATE, + flavor, (thread_state_t) ts, - PPC_THREAD_STATE_COUNT, + count, &thread->kernel_thread), r); } @@ -97,9 +128,17 @@ _pthread_setup(pthread_t thread, r); } ts->eip = (int) routine; - *--sp = (int) thread; /* argument to function */ - *--sp = 0; /* fake return address */ - ts->esp = (int) sp; /* set stack pointer */ + + /* + ** We need to simulate a 16-byte aligned stack frame as if we had + ** executed a call instruction. Since we're "pushing" one argument, + ** we need to adjust the pointer by 12 bytes (3 * sizeof (int *)) + */ + + sp -= 3; /* make sure stack is aligned */ + *--sp = (int) thread; /* argument to function */ + *--sp = 0; /* fake return address */ + ts->esp = (int) sp; /* set stack pointer */ /* Incase of needresume, suspend is always set */ if (suspended) { PTHREAD_MACH_CALL(thread_set_state(thread->kernel_thread, @@ -119,6 +158,95 @@ _pthread_setup(pthread_t thread, r); } +#elif defined(__x86_64__) + x86_thread_state64_t state = {0}; + x86_thread_state64_t *ts = &state; + uintptr_t *sp = vsp; + + /* + * Set up x86-64 registers & function call. + */ + 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; + + /* + ** We need to simulate a 16-byte aligned stack frame as if we had + ** executed a call instruction. The stack should already be aligned + ** before it comes to us and we don't need to push any arguments, + ** so we shouldn't need to change it. + */ + + ts->rdi = (uintptr_t) thread; /* argument to function */ + *--sp = 0; /* fake return address */ + ts->rsp = (uintptr_t) sp; /* set stack pointer */ + /* Incase of needresume, suspend is always set */ + 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; /* PSR_THUMB */ + } + + ts->sp = (uintptr_t)vsp - C_ARGSAVE_LEN - C_RED_ZONE; + ts->r[0] = (uintptr_t)thread; + + /* Incase of needresume, suspend is always set */ + 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