Create bbn_m5atomS3_lite_limit_switch.ino

bareboat-necessities · Nov 4, 2024 · e1c601a · e1c601a
1 parent fc79b2a
commit e1c601a
Showing 1 changed file with 38 additions and 0 deletions.
diff --git a/bbn_m5atomS3_lite_limit_switch/bbn_m5atomS3_lite_limit_switch.ino b/bbn_m5atomS3_lite_limit_switch/bbn_m5atomS3_lite_limit_switch.ino
@@ -0,0 +1,38 @@
+#include <M5AtomS3.h>
+#include "NmeaXDR.h"
+
+#define LIMIT_SWITCH_PIN G8
+
+struct LimitSwitch {
+  bool reached = false;
+  unsigned long last_limit_reported = 0UL;
+};
+
+LimitSwitch limit_switch;
+
+void setup() {
+  auto cfg = M5.config();
+  AtomS3.begin(cfg);
+  Serial.begin(4800);
+
+  pinMode(LIMIT_SWITCH_PIN, INPUT_PULLUP);
+  limit_switch.reached = !digitalRead(LIMIT_SWITCH_PIN);
+}
+
+void loop() {
+  bool reached = !digitalRead(LIMIT_SWITCH_PIN);
+  if (reached != limit_switch.reached) {
+    limit_switch.reached = reached;
+    if (reached) {
+      gen_nmea0183_xdr("$BBXDR,S,1,,LIMIT_NEW", limit_switch.reached);
+    } else {
+      gen_nmea0183_xdr("$BBXDR,S,0,,LIMIT_NEW", limit_switch.reached);
+    }
+    limit_switch.last_limit_reported = millis();
+  }
+  if (millis() - limit_switch.last_limit_reported > 5000) {
+    gen_nmea0183_xdr("$BBXDR,S,%d,,LIMIT_CUR", limit_switch.reached);
+    limit_switch.last_limit_reported = millis();
+  }
+  delay(20);
+}