updates

my_components/nimble_tracker/queue.h

@@ -0,0 +1,65 @@
+// Copied from https://github.com/esphome/esphome/blob/dev/esphome/components/esp32_ble_tracker/queue.h
+#pragma once
+
+#include "esphome/core/component.h"
+#include "esphome/core/helpers.h"
+
+#include <queue>
+#include <mutex>
+#include <cstring>
+
+#include <freertos/FreeRTOS.h>
+#include <freertos/semphr.h>
+
+/*
+ * BLE events come in from a separate Task (thread) in the ESP32 stack. Rather
+ * than trying to deal with various locking strategies, all incoming GAP and GATT
+ * events will simply be placed on a semaphore guarded queue. The next time the
+ * component runs loop(), these events are popped off the queue and handed at
+ * this safer time.
+ */
+
+namespace esphome
+{
+  namespace nimble_tracker
+  {
+
+    template <class T>
+    class Queue
+    {
+    public:
+      Queue() { m_ = xSemaphoreCreateMutex(); }
+
+      void push(T *element)
+      {
+        if (element == nullptr)
+          return;
+        if (xSemaphoreTake(m_, 5L / portTICK_PERIOD_MS))
+        {
+          q_.push(element);
+          xSemaphoreGive(m_);
+        }
+      }
+
+      T *pop()
+      {
+        T *element = nullptr;
+
+        if (xSemaphoreTake(m_, 5L / portTICK_PERIOD_MS))
+        {
+          if (!q_.empty())
+          {
+            element = q_.front();
+            q_.pop();
+          }
+          xSemaphoreGive(m_);
+        }
+        return element;
+      }
+
+    protected:
+      std::queue<T *> q_;
+      SemaphoreHandle_t m_;
+    };
+  } // namespace nimble_tracker
+} // namespace esphome