From b61594308c6625b9294d84571167371702cd9f8a Mon Sep 17 00:00:00 2001
From: Davide Basso <davide.basso@skywarder.eu>
Date: Tue, 6 May 2025 23:00:34 +0200
Subject: [PATCH] [Parafoil] fix: log servo positions after setting it

---
 src/Parafoil/Actuators/Actuators.cpp | 4 ++--
 1 file changed, 2 insertions(+), 2 deletions(-)

diff --git a/src/Parafoil/Actuators/Actuators.cpp b/src/Parafoil/Actuators/Actuators.cpp
index 7d00e4560..ce7276b92 100644
--- a/src/Parafoil/Actuators/Actuators.cpp
+++ b/src/Parafoil/Actuators/Actuators.cpp
@@ -72,8 +72,8 @@ bool Actuators::setServoPosition(ServosList servoId, float position)
 
     miosix::Lock<miosix::FastMutex> lock(actuator->mutex);
 
-    Logger::getInstance().log(actuator->servo->getState());
     actuator->servo->setPosition(position);
+    Logger::getInstance().log(actuator->servo->getState());
 
     return true;
 }
@@ -86,9 +86,9 @@ bool Actuators::setServoAngle(ServosList servoId, Degree angle)
 
     miosix::Lock<miosix::FastMutex> lock(actuator->mutex);
 
-    Logger::getInstance().log(actuator->servo->getState());
     actuator->servo->setPosition(angle.value() /
                                  actuator->fullRangeAngle.value());
+    Logger::getInstance().log(actuator->servo->getState());
 
     return true;
 }
-- 
GitLab