timecounter: Use in RTEMS

Replace timestamp implementation with FreeBSD bintime and timecounters.

New test sptests/sptimecounter02.

Update #2271.

1 files changed, 10 insertions, 9 deletions

diff --git a/cpukit/score/src/coretodset.c b/cpukit/score/src/coretodset.c
index 3d117589a1..3230179414 100644
--- a/cpukit/score/src/coretodset.c
+++ b/cpukit/score/src/coretodset.c
@@ -26,20 +26,21 @@ void _TOD_Set_with_timestamp(
   const Timestamp_Control *tod_as_timestamp
 )
 {
-  TOD_Control *tod = &_TOD;
-  uint32_t nanoseconds = _Timestamp_Get_nanoseconds( tod_as_timestamp );
-  Watchdog_Interval seconds_next = _Timestamp_Get_seconds( tod_as_timestamp );
+  struct timespec ts;
+  uint32_t nanoseconds;
+  Watchdog_Interval seconds_next;
   Watchdog_Interval seconds_now;
-  ISR_lock_Context lock_context;
   Watchdog_Header *header;
 
+  _Timestamp_To_timespec( tod_as_timestamp, &ts );
+  nanoseconds = ts.tv_nsec;
+  seconds_next = ts.tv_sec;
+
   _Thread_Disable_dispatch();
 
   seconds_now = _TOD_Seconds_since_epoch();
 
-  _TOD_Acquire( tod, &lock_context );
-  tod->now = *tod_as_timestamp;
-  _TOD_Release( tod, &lock_context );
+  _Timecounter_Set_clock( &ts );
 
   header = &_Watchdog_Seconds_header;
 
@@ -48,8 +49,8 @@ void _TOD_Set_with_timestamp(
   else
     _Watchdog_Adjust_forward( header, seconds_next - seconds_now );
 
-  tod->seconds_trigger = nanoseconds;
-  tod->is_set = true;
+  _TOD.seconds_trigger = nanoseconds;
+  _TOD.is_set = true;
 
   _Thread_Enable_dispatch();
 }