move pool/queue management into the rf95 lib

src/rf95/TypedQueue.h

@@ -0,0 +1,38 @@
+#pragma once
+
+#include <cassert>
+#include <type_traits>
+
+#include <freertos/FreeRTOS.h>
+#include <freertos/queue.h>
+
+/**
+ * A wrapper for freertos queues.  Note: each element object should be small
+ * and POD (Plain Old Data type) as elements are memcpied by value.
+ */
+template <class T> class TypedQueue
+{
+    static_assert(std::is_pod<T>::value, "T must be pod");
+    QueueHandle_t h;
+
+  public:
+    TypedQueue(int maxElements)
+    {
+        h = xQueueCreate(maxElements, sizeof(T));
+        assert(h);
+    }
+
+    ~TypedQueue() { vQueueDelete(h); }
+
+    int numFree() { return uxQueueSpacesAvailable(h); }
+
+    bool isEmpty() { return uxQueueMessagesWaiting(h) == 0; }
+
+    bool enqueue(T x, TickType_t maxWait = portMAX_DELAY) { return xQueueSendToBack(h, &x, maxWait) == pdTRUE; }
+
+    bool enqueueFromISR(T x, BaseType_t *higherPriWoken) { return xQueueSendToBackFromISR(h, &x, higherPriWoken) == pdTRUE; }
+
+    bool dequeue(T *p, TickType_t maxWait = portMAX_DELAY) { return xQueueReceive(h, p, maxWait) == pdTRUE; }
+
+    bool dequeueFromISR(T *p, BaseType_t *higherPriWoken) { return xQueueReceiveFromISR(h, p, higherPriWoken); }
+};