set safe state if system fault detected

2024-12-13 22:45:03 +01:00 · 2024-12-13 22:45:03 +01:00 · 1dbab68f1d
commit 1dbab68f1d
parent 357608b30a
1 changed files with 8 additions and 2 deletions
--- a/main/safety.c
+++ b/main/safety.c
@ -58,6 +58,12 @@ void taskSafety(void *pvParameters)
        {

            checkSensorSanity();
+
+            if (sSafetyState != SAFETY_NO_ERROR)
+            {
+                setSafeState();
+            }
+
            xSemaphoreGiveRecursive(xMutexAccessSafety);
        }
    }
@ -122,8 +128,8 @@ void checkSensorSanity(void)

 void setSafeState(void)
 {
-    setCirculationPumpState(DISABLED);
-    setBurnerState(DISABLED);
+    setCirculationPumpState(ENABLED); // To cool down system
+    setBurnerState(DISABLED);         // Deactivate burner
 }

 void getSensorSanityStates(sSensorSanityCheck *pSensorSanityChecks)