diff --git a/src/drivers/vmount/input_mavlink.cpp b/src/drivers/vmount/input_mavlink.cpp index f97944035f..e023e51a2d 100644 --- a/src/drivers/vmount/input_mavlink.cpp +++ b/src/drivers/vmount/input_mavlink.cpp @@ -46,6 +46,7 @@ #include #include +#include #include #include @@ -257,9 +258,9 @@ int InputMavlinkCmdMount::update_impl(unsigned int timeout_ms, ControlData **con _control_data.type_data.angle.is_speed[0] = false; _control_data.type_data.angle.is_speed[1] = false; _control_data.type_data.angle.is_speed[2] = false; - _control_data.type_data.angle.angles[0] = vehicle_command.param1; - _control_data.type_data.angle.angles[1] = vehicle_command.param2; - _control_data.type_data.angle.angles[2] = vehicle_command.param3; + _control_data.type_data.angle.angles[0] = vehicle_command.param1 * M_DEG_TO_RAD_F; + _control_data.type_data.angle.angles[1] = vehicle_command.param2 * M_DEG_TO_RAD_F; + _control_data.type_data.angle.angles[2] = vehicle_command.param3 * M_DEG_TO_RAD_F; break;