TLS support for libthreads.

* libthreads/cprocs.c (cproc_create): Call into glibc to allocate static TLS
block.
* libthreads/cthread_internals.h (tcbhead_t): New structure; as in glibc.
(cproc_setup): Take TCB parameter.
(_dl_allocate_tls): Declare; from glibc.
* libthreads/alpha/thread.c (cproc_setup): Compile-time warning for missing TLS
support.
* libthreads/i386/thread.c (cproc_setup): Imlement TLS support.

5 files changed, 62 insertions, 5 deletions

diff --git a/libthreads/ChangeLog b/libthreads/ChangeLog
index eff1ade9..0155c06e 100644
--- a/libthreads/ChangeLog
+++ b/libthreads/ChangeLog
@@ -1,3 +1,17 @@
+2007-06-13  Samuel Thibault  <samuel.thibault@ens-lyon.org>
+
+	TLS support for libthreads.
+
+	* libthreads/cprocs.c (cproc_create): Call into glibc to allocate
+	static TLS block.
+	* libthreads/cthread_internals.h (tcbhead_t): New structure; as in
+	glibc.
+	(cproc_setup): Take TCB parameter.
+	(_dl_allocate_tls): Declare; from glibc.
+	* libthreads/alpha/thread.c (cproc_setup): Compile-time warning for
+	missing TLS support.
+	* libthreads/i386/thread.c (cproc_setup): Imlement TLS support.
+
 2002-08-26  Roland McGrath  <roland@frob.com>
 
 	* cthreads.c (cthread_body) [HAVE_USELOCALE]: Call uselocale to
diff --git a/libthreads/alpha/thread.c b/libthreads/alpha/thread.c
index 2bf5ff64..db2cb0c8 100644
--- a/libthreads/alpha/thread.c
+++ b/libthreads/alpha/thread.c
@@ -65,10 +65,12 @@ extern bzero();
  * so that it will invoke routine(child)
  * when it is resumed.
  */
+#warning TLS support not implemented
 void
 cproc_setup(
 	register cproc_t child,
 	thread_t	 thread,
+	tcbhead_t	*tcb,
 	void 	 	(*routine)(cproc_t))
 {
 	register integer_t			*top;
diff --git a/libthreads/cprocs.c b/libthreads/cprocs.c
index 2195039c..7f63fc0d 100644
--- a/libthreads/cprocs.c
+++ b/libthreads/cprocs.c
@@ -725,10 +725,11 @@ cproc_create(void)
 	spin_lock(&n_kern_lock);
 	if (cthread_max_kernel_threads == 0 ||
 	    cthread_kernel_threads < cthread_max_kernel_threads) {
+		tcbhead_t *tcb = _dl_allocate_tls(NULL);
 		cthread_kernel_threads++;
 		spin_unlock(&n_kern_lock);
 		MACH_CALL(thread_create(mach_task_self(), &n), r);
-		cproc_setup(child, n, cthread_body);	/* machine dependent */
+		cproc_setup(child, n, tcb, cthread_body);	/* machine dependent */
 		MACH_CALL(thread_resume(n), r);
 #ifdef STATISTICS
 		spin_lock(&ready_lock);
diff --git a/libthreads/cthread_internals.h b/libthreads/cthread_internals.h
index 7c557428..84264004 100644
--- a/libthreads/cthread_internals.h
+++ b/libthreads/cthread_internals.h
@@ -147,6 +147,14 @@
 # endif
 #endif
 
+/* Type of the TCB.  */
+typedef struct
+{
+	void *tcb;			/* Points to this structure.  */
+	void *dtv;			/* Vector of pointers to TLS data.  */
+	thread_t self;			/* This thread's control port.  */
+} tcbhead_t;
+
 /*
  * Low-level thread implementation.
  * This structure must agree with struct ur_cthread in cthreads.h
@@ -291,4 +299,10 @@ extern void		cproc_prepare(cproc_t _child,
 				      void (*cthread_body_pc)());
 
 extern void		cproc_setup(cproc_t _child, thread_t _mach_thread,
-				    void (*_routine)(cproc_t));
+				    tcbhead_t *tcb, void (*_routine)(cproc_t));
+
+
+/* From glibc.  */
+
+/* Dynamic linker TLS allocation.  */
+extern void *_dl_allocate_tls(void *);
diff --git a/libthreads/i386/thread.c b/libthreads/i386/thread.c
index c0195a8b..00537be5 100644
--- a/libthreads/i386/thread.c
+++ b/libthreads/i386/thread.c
@@ -61,6 +61,21 @@ char rcs_id[] = "$Header: cvs-sans-libpthread/hurd/libthreads/i386/thread.c,v 1.
 #include <cthreads.h>
 #include "cthread_internals.h"
 #include <mach.h>
+#include <mach/i386/mach_i386.h>
+#include <mach/mig_errors.h>
+
+#define HURD_TLS_DESC_DECL(desc, tcb)					      \
+  struct descriptor desc =						      \
+    {				/* low word: */				      \
+      0xffff			/* limit 0..15 */			      \
+      | (((unsigned int) (tcb)) << 16) /* base 0..15 */			      \
+      ,				/* high word: */			      \
+      ((((unsigned int) (tcb)) >> 16) & 0xff) /* base 16..23 */		      \
+      | ((0x12 | 0x60 | 0x80) << 8) /* access = ACC_DATA_W|ACC_PL_U|ACC_P */  \
+      | (0xf << 16)		/* limit 16..19 */			      \
+      | ((4 | 8) << 20)		/* granularity = SZ_32|SZ_G */		      \
+      | (((unsigned int) (tcb)) & 0xff000000) /* base 24..31 */		      \
+    }
 
 /*
  * Set up the initial state of a MACH thread
@@ -68,7 +83,7 @@ char rcs_id[] = "$Header: cvs-sans-libpthread/hurd/libthreads/i386/thread.c,v 1.
  * when it is resumed.
  */
 void
-cproc_setup(register cproc_t child, thread_t thread, void (*routine)(cproc_t))
+cproc_setup(register cproc_t child, thread_t thread, tcbhead_t *tcb, void (*routine)(cproc_t))
 {
 	extern unsigned int __hurd_threadvar_max; /* GNU */
 	register int *top = (int *)
@@ -81,13 +96,15 @@ cproc_setup(register cproc_t child, thread_t thread, void (*routine)(cproc_t))
 	register struct i386_thread_state *ts = &state;
 	kern_return_t r;
 	unsigned int count;
+	HURD_TLS_DESC_DECL(desc, tcb);
+	int sel;
 
 	/*
 	 * Set up i386 call frame and registers.
 	 * Read registers first to get correct segment values.
 	 */
 	count = i386_THREAD_STATE_COUNT;
-	MACH_CALL(thread_get_state(thread,i386_THREAD_STATE,(thread_state_t) &state,&count),r);
+	MACH_CALL(thread_get_state(thread,i386_REGS_SEGS_STATE,(thread_state_t) &state,&count),r);
 
 	ts->eip = (int) routine;
 	*--top = (int) child;	/* argument to function */
@@ -95,7 +112,16 @@ cproc_setup(register cproc_t child, thread_t thread, void (*routine)(cproc_t))
 	ts->uesp = (int) top;	/* set stack pointer */
 	ts->ebp = 0;		/* clear frame pointer */
 
-	MACH_CALL(thread_set_state(thread,i386_THREAD_STATE,(thread_state_t) &state,i386_THREAD_STATE_COUNT),r);
+	asm ("mov %%gs, %w0" : "=q" (sel) : "0" (0));
+	tcb->tcb = tcb;
+	tcb->self = thread;
+	if (__builtin_expect (sel, 0x48) & 4) /* LDT selector */
+	  __i386_set_ldt (thread, sel, &desc, 1);
+	else
+	  __i386_set_gdt (thread, &sel, desc);
+	ts->gs = sel;
+
+	MACH_CALL(thread_set_state(thread,i386_REGS_SEGS_STATE,(thread_state_t) &state,i386_THREAD_STATE_COUNT),r);
 }
 
 #if	defined(cthread_sp)