From c456e7e932bcd74f21e9626d9da1f56ef0b960cf Mon Sep 17 00:00:00 2001
From: Davide Basso <davide.basso@skywarder.eu>
Date: Sat, 22 Feb 2025 15:58:53 +0100
Subject: [PATCH] [Parafoil] Add logs to servos
---
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 a75f7d804..3d444877f 100644
--- a/src/Parafoil/Actuators/Actuators.cpp
+++ b/src/Parafoil/Actuators/Actuators.cpp
@@ -55,8 +55,8 @@ bool Actuators::start()
leftServo.servo->enable();
rightServo.servo->enable();
- leftServo.servo->setPosition(0);
- rightServo.servo->setPosition(0);
+ setServoPosition(PARAFOIL_LEFT_SERVO, 0.0f);
+ setServoPosition(PARAFOIL_RIGHT_SERVO, 0.0f);
started = true;
return true;
@@ -72,6 +72,7 @@ bool Actuators::setServoPosition(ServosList servoId, float position)
miosix::Lock<miosix::FastMutex> lock(actuator->mutex);
+ Logger::getInstance().log(actuator->servo->getState());
actuator->servo->setPosition(position);
return true;
--
GitLab