Hotfix umwc: send voltage change less often to avoid MCU crash

Signed-off-by: Cornelius Claussen <[email protected]>
EVerest · Oct 15, 2024 · 6af6a00 · 6af6a00
1 parent dce296f
commit 6af6a00
Showing 1 changed file with 9 additions and 5 deletions.
diff --git a/modules/MicroMegaWattBSP/dc_supply/power_supply_DCImpl.cpp b/modules/MicroMegaWattBSP/dc_supply/power_supply_DCImpl.cpp
@@ -29,6 +29,8 @@ void power_supply_DCImpl::init() {
     std::thread([this]() {
         float low_pass_voltage = 0.;
 
+        float last_low_pass_voltage = -1;
+
         while (true) {
             std::this_thread::sleep_for(std::chrono::milliseconds(100));
             // prevent overshoot
@@ -48,13 +50,15 @@ void power_supply_DCImpl::init() {
                 }
             }
 
-            if (is_on) {
-                mod->serial.setOutputVoltageCurrent(low_pass_voltage, req_current);
-
-            } else {
-                mod->serial.setOutputVoltageCurrent(0, 0);
+            if (not is_on) {
                 low_pass_voltage = 0.;
             }
+
+            if (last_low_pass_voltage not_eq low_pass_voltage) {
+                mod->serial.setOutputVoltageCurrent(low_pass_voltage, 0.);
+            }
+
+            last_low_pass_voltage = low_pass_voltage;
         }
     }).detach();
 }