Internal ts test

1 files changed, 27 insertions, 0 deletions

diff --git a/src/common/src/Core/main.c b/src/common/src/Core/main.c
index 75a444a..125671f 100644
--- a/src/common/src/Core/main.c
+++ b/src/common/src/Core/main.c
@@ -305,6 +305,9 @@ static void gps_monit_task(void __attribute__ ((unused))*pvParameters) {
     leds_turn_on(LED_BLUE);
 
     int t_gps_print_latch = 0;
+    int t_gps_hours_handeled = 0;
+    uint64_t last_hour_timestamp = 0;
+
 
     while (1) {
         struct tm time;
@@ -345,6 +348,30 @@ static void gps_monit_task(void __attribute__ ((unused))*pvParameters) {
             t_gps_print_latch = 0;
         }
 
+        if (time_valid && gps_time.tm_sec == 0 && gps_time.tm_min == 0 && t_gps_hours_handeled == 0) {
+
+            uint64_t current_timestamp = timestamp_now();
+
+            if (last_hour_timestamp == 0) {
+                usart_debug("DERIV INIT TS=%i\r\n", current_timestamp);
+            } else {
+
+                usart_debug("DERIV TS=%lld Excepted=%lld Delta=%lld\r\n",
+                    current_timestamp,
+                    last_hour_timestamp + 3600000,
+                    last_hour_timestamp + 3600000 - current_timestamp
+                );
+            }
+
+            last_hour_timestamp = timestamp_now();
+
+            t_gps_hours_handeled = 1;
+        }
+
+        if (gps_time.tm_sec != 0) {
+            t_gps_hours_handeled = 0;
+        }
+
         vTaskDelay(100 / portTICK_RATE_MS);
 
         // Reload watchdog