Add mutex to chairAdjust object - fix potential crashes

common/chairAdjust.cpp

@@ -7,6 +7,7 @@ extern "C"
 #include "chairAdjust.hpp"
 
 
+#define MUTEX_TIMEOUT (10000 / portTICK_PERIOD_MS)
 
 //--- gloabl variables ---
 // strings for logging the rest state
@@ -21,12 +22,12 @@ static const char * TAG = "chair-adjustment";
 //=============================
 //======== constructor ========
 //=============================
-cControlledRest::cControlledRest(gpio_num_t gpio_up_f, gpio_num_t gpio_down_f, uint32_t travelDurationMs, const char * name_f, float defaultPosition):travelDuration(travelDurationMs){
+cControlledRest::cControlledRest(gpio_num_t gpio_up_f, gpio_num_t gpio_down_f, uint32_t travelDurationMs, const char * name_f, float defaultPosition): gpio_up(gpio_up_f), gpio_down(gpio_down_f), travelDuration(travelDurationMs){
     strcpy(name, name_f);
-    gpio_up = gpio_up_f;
-    gpio_down = gpio_down_f;
     positionNow = defaultPosition;
     positionTarget = positionNow;
+    // recursive mutex necessary, because handle() method calls setState() which both have the same mutex
+    mutex = xSemaphoreCreateRecursiveMutex();
     init();
 }
 
@@ -94,6 +95,9 @@ void cControlledRest::updatePosition(){
 //========= setState =========
 //============================
 void cControlledRest::setState(restState_t targetState)
+{
+    // lock the mutex before accessing shared variables
+    if (xSemaphoreTakeRecursive(mutex, MUTEX_TIMEOUT) == pdTRUE)
     {
         // TODO: drop this section?
         // check if actually changed
@@ -139,14 +143,26 @@ void cControlledRest::setState(restState_t targetState)
             break;
         }
         state = targetState;
+
+        // Release the mutex
+        xSemaphoreGiveRecursive(mutex);
+    }
+    else
+    {
+        ESP_LOGE(TAG, "mutex timeout in setState() -> RESTART");
+        esp_restart();
+    }
 }
-
-
 
 //==========================
 //==== setTargetPercent ====
 //==========================
-void cControlledRest::setTargetPercent(float targetPercent){
+void cControlledRest::setTargetPercent(float targetPercent)
+{
+    // lock the mutex before accessing shared variables
+    if (xSemaphoreTakeRecursive(mutex, MUTEX_TIMEOUT) == pdTRUE)
+    {
+        positionTarget = targetPercent;
         float positionTargetPrev = positionTarget;
         positionTarget = targetPercent;
 
@@ -173,17 +189,27 @@ void cControlledRest::setTargetPercent(float targetPercent){
             setState(REST_DOWN);
         else // already at exact position
             setState(REST_OFF);
+
+        // Release the mutex
+        xSemaphoreGiveRecursive(mutex);
+    }
+    else
+    {
+        ESP_LOGE(TAG, "mutex timeout while waiting in setTargetPercent -> RESTART");
+        esp_restart();
+    }
 }
-
-
 
 //======================
 //======= handle =======
 //======================
 // handle automatic stop when target position is reached, should be run repeatedly in a task
 #define TRAVEL_TIME_LIMIT_ADDITION_MS 2000 // traveling longer into limit compensates inaccuracies in time based position tracking
-void cControlledRest::handle(){
+void cControlledRest::handle()
-
+{
+    // lock the mutex before accessing shared variables
+    if (xSemaphoreTakeRecursive(mutex, MUTEX_TIMEOUT) == pdTRUE)
+    {
         // nothing to do when not running atm
         // TODO: turn on automatically when position != target?
         if (state == REST_OFF)
@@ -198,13 +224,21 @@ void cControlledRest::handle(){
             timeTarget += TRAVEL_TIME_LIMIT_ADDITION_MS;
 
         // target reached
-    if (timeRan >= timeTarget){
+        if (timeRan >= timeTarget)
+        {
             ESP_LOGW(TAG, "[%s] handle: reached target run-time (%dms/%dms) for position %.2f%% -> stopping", name, timeRan, timeTarget, positionTarget);
             setState(REST_OFF);
         }
+
+        // Release the mutex
+        xSemaphoreGiveRecursive(mutex);
+    }
+    else
+    {
+        ESP_LOGE(TAG, "mutex timeout while waiting in handle() -> RESTART");
+        esp_restart();
+    }
 }
-
-
 
 //============================
 //===== chairAdjust_task =====

common/chairAdjust.hpp

@@ -3,6 +3,7 @@ extern "C"
 {
 #include "freertos/FreeRTOS.h"
 #include "freertos/task.h"
+#include "freertos/semphr.h"
 #include "driver/gpio.h"
 }
 
@@ -38,11 +39,14 @@ private:
     void init();
     void updatePosition();
 
+    SemaphoreHandle_t mutex;
+
     char name[32];
-    gpio_num_t gpio_up;
+    const gpio_num_t gpio_up;
-    gpio_num_t gpio_down;
+    const gpio_num_t gpio_down;
-    restState_t state;
     const uint32_t travelDuration = 12000;
+
+    restState_t state;
     uint32_t timestamp_lastPosUpdate = 0;
     float positionTarget = 0;
     float positionNow = 0;