fix: freeRTOSEventQueue queue draining on shutdown

cubicap · Jul 10, 2024 · cdb2e3f · cdb2e3f
1 parent 8a88994
commit cdb2e3f
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);
     }
 };