added dtcs for Signal-Timeout and empty tank

2022-03-08 21:23:06 +01:00
parent 0bc6d01a5f
commit 7a84b80126
6 changed files with 39 additions and 1 deletions
--- a/Software/ChainLube/src/can.cpp
+++ b/Software/ChainLube/src/can.cpp
@@ -39,5 +39,19 @@ uint32_t Process_CAN_WheelSpeed()

        return milimeters_to_add;
    }
+
+    if (millis() > lastRecTimestamp + 10000)
+    {
+        if (globals.systemStatus != sysStat_Shutdown)
+            globals.systemStatus = sysStat_Error;
+        MaintainDTC(DTC_NO_CAN_SIGNAL, true);
+    }
+    else
+    {
+        if (globals.systemStatus != sysStat_Shutdown)
+            globals.systemStatus = globals.resumeStatus;
+        MaintainDTC(DTC_NO_CAN_SIGNAL, false);
+    }
+
    return 0;
 }