Initial sync implementation

Implemented system sync with crank and cam state and simple error
handling

STM32/CM7/Core/Src/tasks/cam.c

@@ -4,22 +4,37 @@
 // SPDX-License-Identifier: GPL-3.0-or-later
 
 #include "cmsis_os2.h"
+#include "macros.h"
 #include "main.h"
 #include "ring_buffer.h"
 #include "tasks.h"
-#ifdef DEBUG
-#include "SEGGER_RTT.h"
-#endif
 
 void camHandler(void *argument) {
   for (;;) {
     osThreadFlagsWait(0x01, osFlagsWaitAny, osWaitForever);
-#ifdef DEBUG
-    SEGGER_RTT_printf(0, "Cam pulse detected at: %lu\n\r",
-                      ringBufferRead(&state_g.cam_RB, 0));
-#endif /* ifdef DEBUG */
-    if (state_g.sync == SYNC_OK) {
-      // TODO complete algorithm for scheduling spark
+
+    DEBUG_LOG("Cam pulse detected at: %lu\n\r",
+              ringBufferRead(&state_g.cam_RB, 0));
+
+    // FILTERS
+
+    state_g.cam_state = CAM_TRIGD;
+    state_g.cam_miss_ctr = 0;
+    switch (state_g.sync_state) {
+    case SYNC_NOT_OK: {
+      state_g.sync_state = SYNC_PENDING;
+      DEBUG_LOG("Sync state updated to pending\n\r");
+      break;
+    }
+    case SYNC_PENDING: {
+      if (state_g.crank_state == CYCLE_COMPRESSION) {
+        state_g.sync_state = SYNC_OK;
+        DEBUG_LOG("Sync state updated to OK\n\r");
+      }
+      break;
+    }
+    default:
+      break;
     }
   }
 }