initial

main/Switch.cpp

@@ -0,0 +1,42 @@
+#include "Switch.hpp"
+
+void Switch::Init(int pin,
+                  float update_rate,
+                  Type t,
+                  Polarity pol,
+                  uint8_t mode) {
+    last_update_ = millis();
+    updated_ = false;
+    state_ = 0x00;
+    t_ = t;
+    // Flip may seem opposite to logical direction,
+    // but here 1 is pressed, 0 is not.
+    flip_ = pol == POLARITY_INVERTED ? true : false;
+    pinMode(pin, mode);
+    pin_ = pin;
+}
+void Switch::Init(int pin, float update_rate) {
+    Init(pin,
+         update_rate,
+         TYPE_MOMENTARY,
+         POLARITY_INVERTED,
+         INPUT_PULLUP);
+}
+
+void Switch::Debounce() {
+    // update no faster than 1kHz
+    uint32_t now = millis();
+    updated_ = false;
+
+    if (now - last_update_ >= 1) {
+        last_update_ = now;
+        updated_ = true;
+
+        // shift over, and introduce new state.
+        const bool new_val = digitalRead(pin_);
+        state_ = (state_ << 1) | (flip_ ? !new_val : new_val);
+        // Set time at which button was pressed
+        if (state_ == 0x7f)
+            rising_edge_time_ = millis();
+    }
+}