lap timer

sufst-controller/lapTimer.cpp

+//
+// Created by Sil on 01/08/2019.
+//
+
+#include "lapTimer.h"
+#include "wireless.h"
+
+void lapTimerISR()
+{
+    static uint8_t lapTimerPayload[6];
+
+    static uint32_t lastTriggeredMs = 0;
+
+    uint32_t currentMs = millis();
+
+    if ((currentMs - lastTriggeredMs) >= LAP_TIMER_DEBOUNCE_MS) {
+        lapTimerPayload[0] = 0xFF;
+
+        memcpy(&(lapTimerPayload[1]), currentMs, 4);
+
+        lapTimerPayload[5] = 0xFF;
+
+        wirelessWrite(lapTimerPayload, 6);
+
+        lastTriggeredMs = millis();
+    }
+}
+
+void lapTimerBegin()
+{
+    attachInterrupt(digitalPinToInterrupt(LAP_TIMER_INT_PIN), lapTimerISR, FALLING);
+}

sufst-controller/lapTimer.h

+//
+// Created by Sil on 01/08/2019.
+//
+
+#ifndef LAPTIMER_H
+#define LAPTIMER_H
+
+#include "Arduino.h"
+
+#define LAP_TIMER_INT_PIN 21
+#define LAP_TIMER_DEBOUNCE_MS 1000
+
+void lapTimerBegin();
+
+#endif //LAPTIMER_H

sufst-controller/sufst-controller.ino

@@ -2,7 +2,8 @@
 #include "ecuCan.h"
 #include "can.h"
 #include "dashController.h"
-// #include "wireless.h"
+#include "wireless.h"
+#include "lapTimer.h"
 
 void setup()
 {
@@ -15,10 +16,9 @@ void setup()
     // Serial.println("BEGIN");
 
     dashBegin();
-
     sdBegin();
-
     canBegin();
+    lapTimerBegin();
 }
 
 void loop()
@@ -28,6 +28,7 @@ void loop()
     /*
    * ALL PROCESSES *MUST* BE NON BLOCKING
    */
+
     canProcessRx();
     dashControllerProcess();
     sdProcess();