Engine temp warning messages and bug fixes

src/modules/thermocouple/thermocouple.cpp

@@ -3,6 +3,7 @@
 // SPDX-License-Identifier: GPL-3.0-or-later
 
 #include "thermocouple.h"
+#include "base/router.h"
 #include "data/general_store.h"
 
 int Thermocouple::push(const Task &task) { return queue_.push(task); }
@@ -14,17 +15,56 @@ Thermocouple::Thermocouple(SystemLogger *logger) : logger_(logger) {}
 Thermocouple::~Thermocouple() {}
 
 int Thermocouple::init() {
-    thermocouple_ = new MAX6675(THERMO_SCK, THERMO_CS, THERMO_SO);
-    return 0;
+  thermocouple_ = new MAX6675(THERMO_SCK, THERMO_CS, THERMO_SO);
+  VehicleConfig config;
+  configGlobalRead(config);
+  low_ = config.teng_low_;
+  high_ = config.teng_high_;
+  return 0;
 }
 
 int Thermocouple::loop(unsigned long timeout_ms) {
-   (void)timeout_ms;
+  (void)timeout_ms;
 
-   if (millis() > last_read_at_ + update_interval_) {
+  if (millis() > last_read_at_ + update_interval_) {
     temperature_ = thermocouple_->readCelsius();
     tengGlobalWrite(temperature_);
     last_read_at_ = millis();
-   } 
-   return 0;
+    if (temperature_ > high_) {
+      if (warning_sent_at_ == 0 ||
+          millis() > warning_sent_at_ + warning_timeout_) {
+        router::send(module::Lcd, task::DisplayMsgEngineTempHigh, 2000);
+        warning_sent_at_ = millis();
+      }
+    } else if (temperature_ < low_) {
+      if (warning_sent_at_ == 0 ||
+          millis() > warning_sent_at_ + warning_timeout_) {
+        router::send(module::Lcd, task::DisplayMsgEngineTempLow, 2000);
+        warning_sent_at_ = millis();
+      }
+    }
+
+    Task active_task;
+    int res = queue_.pop(active_task);
+    if (res == 0) {
+      if (active_task.target_ == module::Thermocouple) {
+
+      } else if (active_task.target_ == module::All) {
+
+        switch (active_task.type_) {
+        case task::AllConfigUpdated: {
+          VehicleConfig config;
+          configGlobalRead(config);
+          low_ = config.teng_low_;
+          high_ = config.teng_high_;
+          break;
+        }
+
+        default:
+          break;
+        }
+      };
+    }
+    return 0;
+  }
 }