tq: rewrite for shift register semanticsHEADmaster

1 files changed, 17 insertions, 25 deletions

diff --git a/throttle-quadrant.ino b/throttle-quadrant.ino
index 7c213a1..54740d9 100644
--- a/throttle-quadrant.ino
+++ b/throttle-quadrant.ino
@@ -1,32 +1,24 @@
-#include "protocol.hpp"
+#include "ThrottleQuadrant.hpp"
 
-//! Set up any global state.
-//!
-//! This function is executed once during the start of the firmware.
-auto setup() -> void {
-  // Initialize the protocol subsystem.
-  tq::protocol::init();
+namespace {
 
-  // Initialize the serial output stream.
-  Serial.begin(9600);
-}
+//! The time point (in milliseconds since boot) when we last read out the data of the throttle quadrant.
+auto lastReadTimePoint = 0ul;
 
-//! Perform one iteration through the firmare logic.
-//!
-//! This function is called in an endless loop after the firmware has started.
-auto loop() -> void {
-  // Always try to start a new transfer.
-  tq::protocol::start();
+}
 
-  // Receive a new message if one is available.
-  auto maybe_message = tq::protocol::perform_transfer();
+void setup() {
+  Serial.begin(115200);
+  ThrottleQuadrant.begin(2, 3, 4);
+}
 
-  if (maybe_message.has_value()) {
-    // Extract the received message.
-    auto const& message = maybe_message.value();
+void loop() {
+  auto currentTimePoint = millis();
 
-    Serial.write("new message: ");
-    Serial.write("throttle == ");
-    Serial.print(static_cast<int>(message.throttle));
+  // Read out the throttle quadrant if the minimum amount of wait time has passed.
+  if ((currentTimePoint - lastReadTimePoint) >= ThrottleQuadrant.readDelayMillis) {
+    auto data = ThrottleQuadrant.read();
+    lastReadTimePoint = millis();
+    Serial.write(reinterpret_cast<byte const *>(&data), sizeof(data));
   }
-}
\ No newline at end of file
+}