From e5f16933377b5c9b7df06c8898326b44c0b270a7 Mon Sep 17 00:00:00 2001
From: Davide Basso <davide.basso@skywarder.eu>
Date: Sat, 22 Feb 2025 17:11:45 +0100
Subject: [PATCH] [Parafoil] Fix mavlink set angle

---
 src/Parafoil/Radio/MessageHandler.cpp | 6 +++---
 1 file changed, 3 insertions(+), 3 deletions(-)

diff --git a/src/Parafoil/Radio/MessageHandler.cpp b/src/Parafoil/Radio/MessageHandler.cpp
index b4cc14039..a635e8bc6 100644
--- a/src/Parafoil/Radio/MessageHandler.cpp
+++ b/src/Parafoil/Radio/MessageHandler.cpp
@@ -116,10 +116,10 @@ void Radio::MavlinkBackend::handleMessage(const mavlink_message_t& msg)
 
             auto servo = static_cast<ServosList>(
                 mavlink_msg_set_servo_angle_tc_get_servo_id(&msg));
-            auto position = mavlink_msg_set_servo_angle_tc_get_angle(&msg);
+            auto angle = mavlink_msg_set_servo_angle_tc_get_angle(&msg);
 
-            if (parent.getModule<Actuators>()->setServoPosition(servo,
-                                                                position))
+            if (parent.getModule<Actuators>()->setServoAngle(servo,
+                                                             Degree{angle}))
                 return enqueueAck(msg);
             else
                 return enqueueNack(msg);
-- 
GitLab