Merge pull request #8 from Tasssadar/rtos

fix: freeRTOSEventQueue queue draining on shutdown
cubicap · Jul 10, 2024 · 742d8fb · 742d8fb
2 parents 8a88994 + cdb2e3f
commit 742d8fb
Showing 1 changed file with 10 additions and 2 deletions.
diff --git a/main/espFeatures/freeRTOSEventQueue.h b/main/espFeatures/freeRTOSEventQueue.h
@@ -126,6 +126,15 @@ class FreeRTOSEventQueueFeature : public Next {
         }
     }
 
+    void drain() {
+        while(true) {
+            Event e;
+            if(xQueueReceive(_eventQueue, &e, 0) == pdFALSE) {
+                break;
+            }
+        }
+    }
+
     void _scheduleImpl(auto&&... args) {
         Event e(std::forward<decltype(args)>(args)...);
         auto res = xQueueSend(_eventQueue, &e, portMAX_DELAY);
@@ -217,8 +226,7 @@ class FreeRTOSEventQueueFeature : public Next {
     }
 
     ~FreeRTOSEventQueueFeature() {
-        notifyEventLoop();
-        while (dequeue(false)) {}
+        drain();
         vQueueDelete(_eventQueue);
     }
 };