Loading...
pthreads/thread_setup.c /dev/null Libc-391
--- /dev/null
+++ Libc/Libc-391/pthreads/thread_setup.c
@@ -0,0 +1,162 @@
+/*
+ * Copyright (c) 2000-2003 Apple Computer, 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 
+ *  
+ * Permission to use, copy, modify, and distribute this software and 
+ * its documentation for any purpose and without fee is hereby granted, 
+ * provided that the above copyright notice appears in all copies and 
+ * that both the copyright notice and this permission notice appear in 
+ * supporting documentation. 
+ *  
+ * OSF DISCLAIMS ALL WARRANTIES WITH REGARD TO THIS SOFTWARE 
+ * INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 
+ * FOR A PARTICULAR PURPOSE. 
+ *  
+ * IN NO EVENT SHALL OSF BE LIABLE FOR ANY SPECIAL, INDIRECT, OR 
+ * CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM 
+ * LOSS OF USE, DATA OR PROFITS, WHETHER IN ACTION OF CONTRACT, 
+ * NEGLIGENCE, OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION 
+ * WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 
+ * 
+ */
+/*
+ * MkLinux
+ */
+
+/*
+ * Machine specific support for thread initialization
+ */
+
+#if defined(__ppc__) || defined(__ppc64__)
+#include <architecture/ppc/cframe.h>
+#endif
+
+#include "pthread_internals.h"
+
+/*
+ * Set up the initial state of a MACH thread
+ */
+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
+	/*
+	 * Set up PowerPC registers.
+	 */
+	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;
+	/* 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);
+	}
+#elif defined(__i386__)
+        i386_thread_state_t state = {0};
+        i386_thread_state_t *ts = &state;
+        int *sp = vsp;
+
+        /*
+         * Set up i386 registers & function call.
+         */
+        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;
+
+        /*
+        ** 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,
+					   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);
+	}
+
+#else
+#error _pthread_setup not defined for this architecture
+#endif
+}