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);