Add semaphore

Revert "Add semaphore"

This reverts commit 5656a5e.

ProcessQueue semaphore

main/main.ino

@@ -62,9 +62,13 @@ unsigned long timer_sys_checks = 0;
 #  define ARDUINOJSON_ENABLE_STD_STRING 1
 
 #  include <queue>
+bool processQueue = false;
 #  ifndef QueueSize
-#    define QueueSize 32
+#    define QueueSize 12
 #  endif
+#ifndef QueueTImeOut
+#  define QueueTImeOut 10000
+#endif
 
 #endif
 
@@ -429,6 +433,18 @@ void enqueueJsonObject(const StaticJsonDocument<JSON_MSG_BUFFER>& jsonDoc) {
     Log.error(F("Empty JSON, not enqueued" CR));
     return;
   }
+  unsigned long startMillis = millis();
+  unsigned long currentMillis = millis();
+
+  while (jsonQueue.size() >= QueueSize || processQueue) {
+    currentMillis = millis();
+    Log.warning(F("Queue full or processing, waiting" CR));
+    delay(100);
+    if (currentMillis - startMillis > QueueTImeOut) {
+      Log.error(F("Queue timeout" CR));
+      return;
+    }
+  }
   Log.trace(F("Enqueue JSON" CR));
 #if defined(ESP8266) || defined(ESP32) || defined(__AVR_ATmega2560__) || defined(__AVR_ATmega1280__)
   JsonBundle bundle;
@@ -485,12 +501,13 @@ void buildTopicFromId(JsonObject& Jsondata, const char* origin) {
 // Empty the documents queue
 void emptyQueue() {
   while (true) {
-    JsonBundle bundle;
-
     if (jsonQueue.empty()) {
+      processQueue = false;
       break;
     }
+    JsonBundle bundle;
     Log.trace(F("Dequeue JSON" CR));
+    processQueue = true;
     bundle = jsonQueue.front();
     jsonQueue.pop();