diff --git a/src/Parafoil/Radio/MessageHandler.cpp b/src/Parafoil/Radio/MessageHandler.cpp
index b4cc140398110d0ad348edc57ecaa2a29dce1810..a635e8bc66aa23cd57fe6ae45efd68be5881b7cf 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);