car chassis

Dependencies:   Servo mbed-rtos mbed

Revision:
1:79b1ee0f97ef
Child:
2:7dfc8dd6aab3
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/clock.cpp	Mon Aug 31 22:25:57 2015 +0000
@@ -0,0 +1,24 @@
+#include "car_config.hpp"
+#include "mbed.h"
+#include "rtos.h"
+
+extern can_cmd_time_t can_cmd_time;
+
+void init_clock()
+{
+    set_time(0);
+}
+
+void thread_clock (void const *args)
+{
+    while(1) {
+        //printf("CLOCK\r\n");
+        if (can_cmd_time.flag == CAN_FLAG_RECEIVED) {
+            set_time(can_cmd_time.payload.msg.time);
+            time_t seconds = time(NULL);
+            printf("time: %s\r\n", ctime(&seconds));
+            can_cmd_time.flag = CAN_FLAG_EMPTY;
+        }
+        Thread::wait(CLOCK_THREAD_PERIOD);
+    }
+}