display-qt: Add match time display.

[eurobot/public.git] / src / display-qt / display_orte.cpp

diff --git a/src/display-qt/display_orte.cpp b/src/display-qt/display_orte.cpp
index 2e4005d4629cc77f5df0b31c0fbdedd914e672dd..ea37bfd60b45f5a3af4220ed55bd99adfcc59834 100644 (file)
--- a/src/display-qt/display_orte.cpp
+++ b/src/display-qt/display_orte.cpp
@@ -51,6 +51,29 @@ bool miliseconds_elapsed_since(struct timespec *t, unsigned miliseconds)
 
 ////////////////////////////////////////////////////////////////////////////////////////////////
 
+void rcv_match_time_cb (const ORTERecvInfo *info, void *vinstance, void *recvCallBackParam)
+{
+       OrteSignals *inst=(OrteSignals *)recvCallBackParam;
+       UDE_hw_status_t status = STATUS_FAILED;
+       static UDE_hw_status_t last_status;
+       static struct timespec last_sent;
+        switch (info->status) {
+               case NEW_DATA:
+                       inst->time_con();
+                       status = STATUS_OK;
+                       break;
+               case DEADLINE:
+                       status = STATUS_FAILED;
+                       break;
+       }
+//     if (status != last_status ||
+//         miliseconds_elapsed_since(&last_sent, 1000)) {
+//             inst->status_con(PWR, status);
+//             clock_gettime(CLOCK_MONOTONIC, &last_sent);
+//     }
+//     last_status = status;
+}
+
 void rcv_pwr_voltage_cb (const ORTERecvInfo *info, void *vinstance, void *recvCallBackParam)
 {
        OrteSignals *inst=(OrteSignals *)recvCallBackParam;