adding the possibility to schedule execution of tasks

Author: andreagilardoni

UNOR4USBBridge/at_handler.cpp

@@ -69,6 +69,20 @@ CClientWrapper CAtHandler::getClient(int sock) {
 void CAtHandler::run() {
 /* -------------------------------------------------------------------------- */
   at_srv.run();
+
+  // execute all the pending tasks
+
+  // it is intended for the tasks to add other tasks in queue after being executed,
+  // saving the current size of the queue
+  auto size = tasks.size();
+  for(int i=0; i<size; i++) {
+    auto task = tasks.front();
+    tasks.pop();
+    if(task) {
+      task();
+    }
+  }
+
   vTaskDelay(1);
 }
 

UNOR4USBBridge/at_handler.h

@@ -4,6 +4,7 @@
 #include "chAT.hpp"
 #include "WiFi.h"
 #include "Server.h"
+#include <queue>
 
 #include "WiFiClient.h"
 #include <WiFiClientSecure.h>
@@ -66,6 +67,10 @@ class CAtHandler {
    std::vector<std::uint8_t> clients_ca[MAX_CLIENT_AVAILABLE];
    std::vector<std::uint8_t> clients_cert_pem[MAX_CLIENT_AVAILABLE];
    std::vector<std::uint8_t> clients_key_pem[MAX_CLIENT_AVAILABLE];
+
+   // this vector is a list of function to be called in the run function
+   std::queue<std::function<void()>> tasks;
+
    int udps_num = 0;
    int servers_num = 0;
    int clientsToServer_num = 0;
@@ -90,6 +95,10 @@ class CAtHandler {
    void add_cmds_preferences();
    void add_cmds_se();
 public:
+   inline void addTask(std::function<void()> task) {
+      tasks.push(task);
+   }
+
    /* Used by cmds_se */
    std::vector<std::uint8_t> se_buf;