From 16c9e9a900cf1ba07d46c991b75d399cc48ba149 Mon Sep 17 00:00:00 2001
From: Davide Basso <davide.basso@skywarder.eu>
Date: Sat, 22 Feb 2025 22:07:40 +0100
Subject: [PATCH] [Parafoil] Add missing servo log

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

diff --git a/src/Parafoil/Actuators/Actuators.cpp b/src/Parafoil/Actuators/Actuators.cpp
index 3d444877f..7d00e4560 100644
--- a/src/Parafoil/Actuators/Actuators.cpp
+++ b/src/Parafoil/Actuators/Actuators.cpp
@@ -52,8 +52,8 @@ Actuators::Actuators()
 
 bool Actuators::start()
 {
-    leftServo.servo->enable();
-    rightServo.servo->enable();
+    enableServo(PARAFOIL_LEFT_SERVO);
+    enableServo(PARAFOIL_RIGHT_SERVO);
 
     setServoPosition(PARAFOIL_LEFT_SERVO, 0.0f);
     setServoPosition(PARAFOIL_RIGHT_SERVO, 0.0f);
@@ -86,6 +86,7 @@ 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());
 
-- 
GitLab