From 1dbab68f1d0b0ac66a1f29ab6f883759c7ea16a01092d2dbc439d979c69ba1a7 Mon Sep 17 00:00:00 2001
From: localhorst <localhorst@mosad.xyz>
Date: Fri, 13 Dec 2024 22:45:03 +0100
Subject: [PATCH] set safe state if system fault detected

---
 main/safety.c | 10 ++++++++--
 1 file changed, 8 insertions(+), 2 deletions(-)

diff --git a/main/safety.c b/main/safety.c
index 24ff2db..d490821 100644
--- 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)