Changeset 7b0c74ff in rtems

Timestamp:

Jun 9, 2017, 1:42:36 PM (2 years ago)

Author:

Sebastian Huber <sebastian.huber@…>

Branches:

master

Children:

86c1004

Parents:

cb0d9a0

git-author:

Sebastian Huber <sebastian.huber@…> (06/09/17 13:42:36)

git-committer:

Sebastian Huber <sebastian.huber@…> (06/12/17 06:01:58)

Message:

i386: Support thread-local storage (TLS)

Update #2468.

Files:

• c/src/lib/libbsp/i386/pc386/include/tblsizes.h (modified) (1 diff)
• c/src/lib/libbsp/i386/pc386/startup/ldsegs.S (modified) (2 diffs)
• c/src/lib/libbsp/i386/shared/irq/idt.c (modified) (2 diffs)
• cpukit/score/cpu/i386/cpu.c (modified) (4 diffs)
• cpukit/score/cpu/i386/cpu_asm.S (modified) (2 diffs)
• cpukit/score/cpu/i386/rtems/score/cpu.h (modified) (2 diffs)
• cpukit/score/include/rtems/score/tls.h (modified) (3 diffs)

c/src/lib/libbsp/i386/pc386/include/tblsizes.h

@@ -21 +21 @@
 
 #define IDT_SIZE (256)
-#define GDT_SIZE (3 + NUM_APP_DRV_GDT_DESCRIPTORS)
+#define NUM_SYSTEM_GDT_DESCRIPTORS 4
+#define GDT_SIZE (NUM_SYSTEM_GDT_DESCRIPTORS + NUM_APP_DRV_GDT_DESCRIPTORS)

c/src/lib/libbsp/i386/pc386/startup/ldsegs.S

@@ -172 +172 @@
 | GDT itself
 +--------------------------------------------------------------------------*/
-#if GDT_SIZE < 3
-#error "GDT_SIZE must be at least 3"
+#if GDT_SIZE < NUM_SYSTEM_GDT_DESCRIPTORS
+#error "GDT_SIZE must be at least NUM_SYSTEM_GDT_DESCRIPTORS"
 #endif
 
@@ -194 +194 @@
         .byte 0, 0x92, 0xcf, 0
 
+        /* gs segment */
+        .word 0xffff, 0
+        .byte 0, 0x92, 0xcf, 0
+
         /* allocated space for user segments */
-        .rept (GDT_SIZE - 3)
+        .rept (GDT_SIZE - NUM_SYSTEM_GDT_DESCRIPTORS)
         .word 0,0,0,0
         .endr

c/src/lib/libbsp/i386/shared/irq/idt.c

@@ -19 +19 @@
 #include <rtems/score/cpu.h>
 #include <bsp/irq.h>
+#include <bsp/tblsizes.h>
 
 /*
@@ -332 +333 @@
     segment_descriptors*    gdt_entry_tbl;
     /* initial amount of filled descriptors */
-    static uint16_t         segment_selector_index = 2;
+    static uint16_t         segment_selector_index = NUM_SYSTEM_GDT_DESCRIPTORS - 1;
 
     segment_selector_index += 1;

cpukit/score/cpu/i386/cpu.c

@@ -25 +25 @@
 #include <rtems/score/isr.h>
 #include <rtems/score/idtr.h>
+#include <rtems/score/tls.h>
 
 #include <rtems/bspIo.h>
@@ -43 +44 @@
 I386_ASSERT_OFFSET(esi, ESI);
 I386_ASSERT_OFFSET(edi, EDI);
+
+RTEMS_STATIC_ASSERT(
+  offsetof(Context_Control, gs)
+    == I386_CONTEXT_CONTROL_GS_0_OFFSET,
+  Context_Control_gs_0
+);
 
 #ifdef RTEMS_SMP
@@ -154 +161 @@
 {
   uint32_t _stack;
+  uint32_t tcb;
 
   (void) is_fp; /* avoid warning for being unused */
@@ -169 +177 @@
   the_context->ebp     = (void *) 0;
   the_context->esp     = (void *) _stack;
+
+  if ( tls_area != NULL ) {
+    tcb = (uint32_t) _TLS_TCB_after_TLS_block_initialize( tls_area );
+  } else {
+    tcb = 0;
+  }
+
+  the_context->gs.limit_15_0 = 0xffff;
+  the_context->gs.base_address_15_0 = (tcb >> 0) & 0xffff;
+  the_context->gs.type = 0x2;
+  the_context->gs.descriptor_type = 0x1;
+  the_context->gs.limit_19_16 = 0xf;
+  the_context->gs.present = 0x1;
+  the_context->gs.operation_size = 0x1;
+  the_context->gs.granularity = 0x1;
+  the_context->gs.base_address_23_16 = (tcb >> 16) & 0xff;
+  the_context->gs.base_address_31_24 = (tcb >> 24) & 0xff;
 }
 

cpukit/score/cpu/i386/cpu_asm.S

@@ -33 +33 @@
 .set REG_ESI,     I386_CONTEXT_CONTROL_ESI_OFFSET
 .set REG_EDI,     I386_CONTEXT_CONTROL_EDI_OFFSET
+.set REG_GS_0,    I386_CONTEXT_CONTROL_GS_0_OFFSET
+.set REG_GS_1,    I386_CONTEXT_CONTROL_GS_1_OFFSET
 
         BEGIN_CODE
@@ -84 +86 @@
         movl      REG_ESI(eax),esi         /* restore source register */
         movl      REG_EDI(eax),edi         /* restore destination register */
+        movl      REG_GS_0(eax), ecx       /* restore gs segment */
+        movl      REG_GS_1(eax), edx
+        movl      ecx, _Global_descriptor_table + 24
+        movl      edx, _Global_descriptor_table + 28
+        movl      $24, ecx
+        mov       ecx, gs
         ret
 

cpukit/score/cpu/i386/rtems/score/cpu.h

@@ -123 +123 @@
 #define I386_CONTEXT_CONTROL_ESI_OFFSET 16
 #define I386_CONTEXT_CONTROL_EDI_OFFSET 20
+#define I386_CONTEXT_CONTROL_GS_0_OFFSET 24
+#define I386_CONTEXT_CONTROL_GS_1_OFFSET 28
 
 #ifdef RTEMS_SMP
-  #define I386_CONTEXT_CONTROL_IS_EXECUTING_OFFSET 24
+  #define I386_CONTEXT_CONTROL_IS_EXECUTING_OFFSET 32
 #endif
 
@@ -137 +139 @@
 
 typedef struct {
-  uint32_t    eflags;   /* extended flags register                   */
-  void       *esp;      /* extended stack pointer register           */
-  void       *ebp;      /* extended base pointer register            */
-  uint32_t    ebx;      /* extended bx register                      */
-  uint32_t    esi;      /* extended source index register            */
-  uint32_t    edi;      /* extended destination index flags register */
+  uint32_t    eflags;     /* extended flags register                   */
+  void       *esp;        /* extended stack pointer register           */
+  void       *ebp;        /* extended base pointer register            */
+  uint32_t    ebx;        /* extended bx register                      */
+  uint32_t    esi;        /* extended source index register            */
+  uint32_t    edi;        /* extended destination index flags register */
+  segment_descriptors gs; /* gs segment descriptor                     */
 #ifdef RTEMS_SMP
   volatile bool is_executing;

cpukit/score/include/rtems/score/tls.h

@@ -71 +71 @@
 } TLS_Dynamic_thread_vector;
 
-typedef struct {
+typedef struct TLS_Thread_control_block {
+#ifdef __i386__
+  struct TLS_Thread_control_block *tcb;
+#else
   TLS_Dynamic_thread_vector *dtv;
   uintptr_t reserved;
+#endif
 } TLS_Thread_control_block;
 
@@ -110 +114 @@
 )
 {
-  uintptr_t aligned_size = _TLS_Heap_align_up( size );
-
-  return _TLS_Get_thread_control_block_area_size( alignment )
-    + aligned_size + sizeof(TLS_Dynamic_thread_vector);
+  uintptr_t allocation_size = 0;
+
+  allocation_size += _TLS_Heap_align_up( size );
+  allocation_size += _TLS_Get_thread_control_block_area_size( alignment );
+
+#ifndef __i386__
+  allocation_size += sizeof(TLS_Dynamic_thread_vector);
+#endif
+
+  return allocation_size;
 }
 
@@ -141 +151 @@
 )
 {
+#ifdef __i386__
+  (void) dtv;
+  tcb->tcb = tcb;
+#else
   tcb->dtv = dtv;
   dtv->generation_number = 1;
   dtv->tls_blocks[0] = tls_block;
+#endif
 
   return _TLS_Copy_and_clear( tls_block );