score: Add _CPU_Get_TLS_thread_pointer()

Add _CPU_Get_TLS_thread_pointer() to get the thread pointer which is
used to get the address of thread-local storage objects associated with
a thread.

Update #4920.

cpukit/score/cpu/aarch64/include/rtems/score/cpuimpl.h

@@ -174,6 +174,13 @@ static inline void _CPU_Use_thread_local_storage(
   );
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) context->thread_id;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/arm/include/rtems/score/cpuimpl.h

@@ -178,6 +178,13 @@ static inline void _CPU_Use_thread_local_storage(
 #endif
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) context->thread_id;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/bfin/include/rtems/score/cpuimpl.h

@@ -72,6 +72,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

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

@@ -112,6 +112,13 @@ static inline void _CPU_Use_thread_local_storage(
   );
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) &context->gs;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/lm32/include/rtems/score/cpuimpl.h

@@ -71,6 +71,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/m68k/include/rtems/score/cpuimpl.h

@@ -95,6 +95,13 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) context->thread_pointer;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/microblaze/include/rtems/score/cpuimpl.h

@@ -100,6 +100,13 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) context->thread_pointer;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/mips/include/rtems/score/cpuimpl.h

@@ -91,6 +91,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/moxie/include/rtems/score/cpuimpl.h

@@ -91,6 +91,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/nios2/include/rtems/score/cpuimpl.h

@@ -84,6 +84,13 @@ static inline void _CPU_Use_thread_local_storage(
    __asm__ volatile ( "" : : "r" ( r23 ) );
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) context->r23;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/no_cpu/include/rtems/score/cpuimpl.h

@@ -201,6 +201,22 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+/**
+ * @brief Gets the thread pointer of the context.
+ *
+ * The thread pointer is used to get the address of thread-local storage
+ * objects associated with a thread.
+ *
+ * @param context is the processor context containing the thread pointer.
+ */
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/or1k/include/rtems/score/cpuimpl.h

@@ -79,6 +79,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/powerpc/include/rtems/score/cpuimpl.h

@@ -301,6 +301,13 @@ static inline void _CPU_Use_thread_local_storage(
    __asm__ volatile ( "" : : "r" ( tp ) );
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) ppc_get_context( context )->tp;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/riscv/include/rtems/score/cpuimpl.h

@@ -454,6 +454,13 @@ static inline void _CPU_Use_thread_local_storage(
    __asm__ volatile ( "" : : "r" ( tp ) );
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) context->tp;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/sh/include/rtems/score/cpuimpl.h

@@ -72,6 +72,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/sparc/include/rtems/score/cpuimpl.h

@@ -251,6 +251,13 @@ static inline void _CPU_Use_thread_local_storage(
    __asm__ volatile ( "" : : "r" ( g7 ) );
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  return (void *) context->g7;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/sparc64/include/rtems/score/cpuimpl.h

@@ -91,6 +91,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/v850/include/rtems/score/cpuimpl.h

@@ -91,6 +91,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

cpukit/score/cpu/x86_64/include/rtems/score/cpuimpl.h

@@ -75,6 +75,14 @@ static inline void _CPU_Use_thread_local_storage(
   (void) context;
 }
 
+static inline void *_CPU_Get_TLS_thread_pointer(
+  const Context_Control *context
+)
+{
+  (void) context;
+  return NULL;
+}
+
 #ifdef __cplusplus
 }
 #endif

testsuites/sptests/sptls01/init.c

@@ -32,6 +32,8 @@
 #include <rtems/bspIo.h>
 #include <rtems/stackchk.h>
 #include <rtems/sysinit.h>
+#include <rtems/score/cpuimpl.h>
+#include <rtems/score/threadimpl.h>
 #include <rtems/score/tls.h>
 
 #include "tmacros.h"
@@ -57,6 +59,7 @@ static void task(rtems_task_argument arg)
   rtems_status_code sc;
 
   check_tls_item(123);
+  tls_item = 42;
 
   sc = rtems_event_transient_send(master_task);
   rtems_test_assert(sc == RTEMS_SUCCESSFUL);
@@ -85,10 +88,27 @@ static void check_tls_size(void)
   }
 }
 
+static Thread_Control *get_thread(rtems_id id)
+{
+  Thread_Control *the_thread;
+  ISR_lock_Context lock_context;
+
+  the_thread = _Thread_Get(id, &lock_context);
+  _ISR_lock_ISR_enable(&lock_context);
+  return the_thread;
+}
+
 static void test(void)
 {
   rtems_id id;
   rtems_status_code sc;
+  Thread_Control *self;
+  Thread_Control *other;
+  char *self_tp;
+  char *other_tp;
+  uintptr_t tls_item_offset;
+  char *self_tls_item;
+  char *other_tls_item;
 
   master_task = rtems_task_self();
 
@@ -111,9 +131,22 @@ static void test(void)
   sc = rtems_task_start(id, task, 0);
   rtems_test_assert(sc == RTEMS_SUCCESSFUL);
 
+  self = get_thread(master_task);
+  other = get_thread(id);
+  self_tp = _CPU_Get_TLS_thread_pointer(&self->Registers);
+  other_tp = _CPU_Get_TLS_thread_pointer(&other->Registers);
+  tls_item_offset = (uintptr_t) (&tls_item - self_tp);
+  self_tls_item = self_tp + tls_item_offset;
+  other_tls_item = other_tp + tls_item_offset;
+  rtems_test_assert(*self_tls_item == 5);
+  rtems_test_assert(*other_tls_item == 123);
+
   sc = rtems_event_transient_receive(RTEMS_WAIT, RTEMS_NO_TIMEOUT);
   rtems_test_assert(sc == RTEMS_SUCCESSFUL);
 
+  rtems_test_assert(*self_tls_item == 5);
+  rtems_test_assert(*other_tls_item == 42);
+
   sc = rtems_task_delete(id);
   rtems_test_assert(sc == RTEMS_SUCCESSFUL);