Change RF95 to deliver packets straight from ISR and no polling for anything

src/TypedQueue.h

@@ -1,4 +1,4 @@
-#pragma once 
+#pragma once
 
 #include <Arduino.h>
 #include <assert.h>
@@ -7,29 +7,47 @@
  * A wrapper for freertos queues.  Note: each element object must be quite small, so T should be only
  * pointer types or ints
  */
-template <class T> class TypedQueue {
+template <class T>
+class TypedQueue
+{
     QueueHandle_t h;
+
 public:
-    TypedQueue(int maxElements) {
+    TypedQueue(int maxElements)
+    {
         h = xQueueCreate(maxElements, sizeof(T));
         assert(h);
     }
 
-    ~TypedQueue() {
+    ~TypedQueue()
+    {
         vQueueDelete(h);
     }
 
-    int numFree() {
+    int numFree()
+    {
         return uxQueueSpacesAvailable(h);
     }
 
     // pdTRUE for success else failure
-    BaseType_t enqueue(T x, TickType_t maxWait = portMAX_DELAY) {
+    BaseType_t enqueue(T x, TickType_t maxWait = portMAX_DELAY)
+    {
         return xQueueSendToBack(h, &x, maxWait);
     }
 
+    BaseType_t enqueueFromISR(T x, BaseType_t *higherPriWoken)
+    {
+        return xQueueSendToBackFromISR(h, &x, higherPriWoken);
+    }
+
     // pdTRUE for success else failure
-    BaseType_t dequeue(T *p, TickType_t maxWait = portMAX_DELAY) {
+    BaseType_t dequeue(T *p, TickType_t maxWait = portMAX_DELAY)
+    {
         return xQueueReceive(h, p, maxWait);
     }
+
+    BaseType_t dequeueFromISR(T *p, BaseType_t *higherPriWoken)
+    {
+        return xQueueReceiveFromISR(h, p, higherPriWoken);
+    }
 };