More EStop de-bounce fixing

OpenShock · Oct 9, 2024 · 97709f6 · 97709f6
1 parent 0845df4
commit 97709f6
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/src/EStopManager.cpp b/src/EStopManager.cpp
@@ -92,7 +92,6 @@ void _estopEdgeInterrupt(void* arg) {
 
   // Debounce the EStop
   bool debounce = now - s_lastStateChange < k_estopDebounceTime;
-  s_lastStateChange = now;
   if (debounce) {
     return;
   }
@@ -104,6 +103,8 @@ void _estopEdgeInterrupt(void* arg) {
   if (pressed == s_lastState) {
     return;
   }
+  s_lastState       = pressed;
+  s_lastStateChange = now;
 
   bool deactivatesAtChanged = false;
   int64_t deactivatesAt     = 0;