code etwas in kleinere Fuinktionen unterteiltHEADmaster

1 files changed, 34 insertions, 2 deletions

diff --git a/src/app.cpp b/src/app.cpp
index fb7659d..8d89b05 100644
--- a/src/app.cpp
+++ b/src/app.cpp
@@ -4,6 +4,7 @@
 #include <functional>
 #include <iostream>
 #include <map>
+#include <numeric>
 #include <span>
 #include <string>
 
@@ -107,6 +108,18 @@ print_hex(string_view message, span<const unsigned char> data)
         cout << '\n';
 }
 
+uint16_t
+decode_heartbeat(span<const uint8_t> data)
+{
+        static const uint16_t mask = 0b0011'1111'1111'1111U;
+
+        auto msb   = static_cast<uint16_t>(data[0]);
+        auto lsb   = static_cast<uint16_t>(data[1]);
+        auto count = ((msb << 8U) | lsb) & mask;
+
+        return count;
+}
+
 bool
 sync(asio::serial_port& port, asio::io_context& context)
 {
@@ -281,7 +294,19 @@ run()
                         asio::write(port, asio::buffer("<HEARTBEAT1>>"));
 
                         thread = jthread([&context, &port]() {
-                                array<unsigned char, 1000> buffer{};
+                                array<uint8_t, 1000> buffer{};
+
+                                uint64_t            second{};
+                                array<uint16_t, 60> counts{};
+
+                                auto update_counts = [&counts, &second](uint16_t count) {
+                                        counts.at(second++ % counts.size()) = count;
+
+                                        if ( second >= counts.size() ) {
+                                                auto cpm = accumulate(counts.begin(), counts.end(), uint32_t(0));
+                                                cout << "CPM: " << cpm << '\n';
+                                        }
+                                };
 
                                 function<void()> readFromPort = [&]() {
                                         port.async_read_some(asio::buffer(buffer, buffer.size()), [&](std::error_code error, size_t length) {
@@ -290,7 +315,14 @@ run()
                                                         return;
                                                 }
 
-                                                print_hex("Daten:", { buffer.data(), length });
+                                                if ( length == 2 ) {
+                                                        const auto count = decode_heartbeat(buffer);
+
+                                                        update_counts(count);
+                                                }
+                                                else {
+                                                        print_hex("HB Daten:", { buffer.data(), length });
+                                                }
 
                                                 readFromPort();
                                         });