🚌 Adds eventbus with bluetooth adapter

2025-07-08 01:25:35 +02:00
parent 01d46f283b
commit 06b05b2dc1
12 changed files with 532 additions and 1 deletions
@@ -0,0 +1,60 @@
+#pragma once
+#include <BLEDevice.h>
+#include <BLEServer.h>
+#include <BLEUtils.h>
+#include <BLE2902.h>
+
+#include "comm_base.hpp"
+#include "event_bus.hpp"
+#include "topic.hpp"
+
+class BluetoothService : public CommBase<> {
+    BLEServer* bleServer {nullptr};
+    BLECharacteristic* txCharacteristic {nullptr};
+    BLECharacteristic* rxCharacteristic {nullptr};
+    bool connected {false};
+
+  protected:
+    template <typename Msg>
+    using EventBusHandle = typename EventBus<Msg>::Handle;
+
+    template <typename Msg>
+    EventBusHandle<Msg>& getHandle(Topic topic) {
+        return *static_cast<EventBusHandle<Msg>*>(subscriptionHandle[static_cast<size_t>(topic)]);
+    }
+
+    template <typename Msg>
+    void setHandle(Topic topic, EventBusHandle<Msg>&& handle) {
+        subscriptionHandle[static_cast<size_t>(topic)] = new EventBusHandle<Msg>(std::move(handle));
+    }
+
+    std::array<void*, static_cast<size_t>(Topic::COUNT)> subscriptionHandle {};
+
+  private:
+    void handleReceive(const std::string& data);
+    void send(size_t clientId, const char* data, size_t len) override;
+
+    struct ServerCb : BLEServerCallbacks {
+        BluetoothService* svc;
+        ServerCb(BluetoothService* s) : svc(s) {}
+        void onConnect(BLEServer*) override { svc->connected = true; }
+        void onDisconnect(BLEServer* s) override {
+            svc->connected = false;
+            for (size_t i = 0; i < static_cast<size_t>(Topic::COUNT); ++i) svc->unsubscribe(static_cast<Topic>(i), 0);
+            svc->bleServer->startAdvertising();
+        }
+    };
+
+    struct RxCb : BLECharacteristicCallbacks {
+        BluetoothService* svc;
+        RxCb(BluetoothService* s) : svc(s) {}
+        void onWrite(BLECharacteristic* c) override {
+            auto v = c->getValue();
+            if (!v.empty()) svc->handleReceive(v);
+        }
+    };
+
+  public:
+    void begin(const char* name);
+    void loop() {}
+};
@@ -0,0 +1,63 @@
+#pragma once
+#include <ArduinoJson.h>
+#include <array>
+#include <bitset>
+#include <freertos/FreeRTOS.h>
+#include "topic.hpp"
+
+#ifndef MAX_CID
+#define MAX_CID 4
+#endif
+
+enum class MsgKind : uint8_t { Connect = 0, Disconnect = 1, Event = 2, Ping = 3, Pong = 4 };
+
+template <size_t MaxCid = MAX_CID, size_t NTopics = static_cast<size_t>(Topic::COUNT)>
+class CommBase {
+    using Bits = std::bitset<MaxCid>;
+    std::array<Bits, NTopics> subs_;
+    portMUX_TYPE mux_ portMUX_INITIALIZER_UNLOCKED;
+
+    static constexpr size_t idx(Topic t) { return static_cast<size_t>(t); }
+
+    template <Topic T>
+    void encode(JsonDocument& d, const typename TopicTraits<T>::Msg& m) {
+        auto a = d.to<JsonArray>();
+        a.add(static_cast<uint8_t>(MsgKind::Event));
+        a.add(static_cast<uint8_t>(T));
+        toJson(a.add<JsonVariant>(), m);
+    }
+
+  protected:
+    virtual void send(size_t cid, const char* data, size_t len) = 0;
+
+  public:
+    void subscribe(Topic t, size_t cid) {
+        portENTER_CRITICAL(&mux_);
+        subs_[idx(t)].set(cid);
+        portEXIT_CRITICAL(&mux_);
+    }
+
+    void unsubscribe(Topic t, size_t cid) {
+        portENTER_CRITICAL(&mux_);
+        subs_[idx(t)].reset(cid);
+        portEXIT_CRITICAL(&mux_);
+    }
+
+    bool has(Topic t) const { return subs_[idx(t)].any(); }
+
+    template <Topic T>
+    void emit(const typename TopicTraits<T>::Msg& m) {
+        if (!has(T)) return;
+        JsonDocument doc;
+        encode<T>(doc, m);
+        String out;
+#if USE_MSGPACK
+        serializeMsgPack(doc, out);
+#else
+        serializeJson(doc, out);
+#endif
+        auto& b = subs_[idx(T)];
+        for (size_t cid = 0; cid < MaxCid; ++cid)
+            if (b.test(cid)) send(cid, out.c_str(), out.length());
+    }
+};