etc switch debouncing

Author: Mayamelon

ETC/src/etc_controller.cpp

@@ -23,7 +23,12 @@ ETCController::ETCController()
         this->state.cockpit = false;
     }));
     this->cockpitSwitchInterrupt.fall(callback([this]() {
-        this->checkStartConditions();
+        this->cockpitSwitchTicker.attach(callback([this]() {
+            if (!cockpitSwitchInterrupt.read()) {
+                this->checkStartConditions();
+            }
+            this->cockpitSwitchTicker.detach();
+        }), 100ms);
         this->state.cockpit = true;
     }));
     this->reverseSwitchInterrupt.rise(callback([this]() { this->switchForwardMotor(); }));
@@ -131,8 +136,10 @@ void ETCController::checkStartConditions() {
 
 
 void ETCController::runRTDS() {
-    this->rtdsOutput.write(true);
-    this->rtdsTicker.attach(callback([this] {this->stopRTDS();}), 1000ms);
+    if (!this->rtdsOutput.read()) {
+        this->rtdsOutput.write(true);
+        this->rtdsTicker.attach(callback([this] {this->stopRTDS();}), 1000ms);
+    }
 }
 
 

ETC/src/etc_controller.h

@@ -77,6 +77,9 @@ class ETCController {
     /** Timer for the RTDS activation. */
     Ticker rtdsTicker;
 
+    /** Ticker for debouncing cockpit switch */
+    Ticker cockpitSwitchTicker;
+
     /** State of the ETC. */
     ETCState state;
 
@@ -153,6 +156,10 @@ class ETCController {
      */
     void checkStartConditions();
 
+    /**
+     * Wait and check again before allowing starting
+     */
+    void debounceCockpitSwitch();
 
     /**
      * Runs the RTDS buzzer for 3 seconds.