diff --git a/src/Parafoil/Actuators/Actuators.cpp b/src/Parafoil/Actuators/Actuators.cpp index 7d00e4560ca033d6019854c3859a63c55a26f6d7..ce7276b92aa8af2f88c5a4e221f2dd817d828486 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; }