From b0f766d90e2d08649e2a26fa241c9a5f35d17536 Mon Sep 17 00:00:00 2001 From: Daniel Agar Date: Fri, 13 Jul 2018 09:13:18 -0400 Subject: [PATCH] mavlink MOUNT_ORIENTATION use math::degrees --- src/modules/mavlink/mavlink_messages.cpp | 7 +++---- 1 file changed, 3 insertions(+), 4 deletions(-) diff --git a/src/modules/mavlink/mavlink_messages.cpp b/src/modules/mavlink/mavlink_messages.cpp index 4bfec1a7d1..6a254aea01 100644 --- a/src/modules/mavlink/mavlink_messages.cpp +++ b/src/modules/mavlink/mavlink_messages.cpp @@ -1060,7 +1060,6 @@ protected: actuator_armed_s armed = {}; airspeed_s airspeed = {}; - bool updated = false; updated |= _pos_sub->update(&_pos_time, &pos); updated |= _armed_sub->update(&_armed_time, &armed); @@ -3950,9 +3949,9 @@ protected: mavlink_mount_orientation_t msg = {}; - msg.roll = 180.0f / M_PI_F * mount_orientation.attitude_euler_angle[0]; - msg.pitch = 180.0f / M_PI_F * mount_orientation.attitude_euler_angle[1]; - msg.yaw = 180.0f / M_PI_F * mount_orientation.attitude_euler_angle[2]; + msg.roll = math::degrees(mount_orientation.attitude_euler_angle[0]); + msg.pitch = math::degrees(mount_orientation.attitude_euler_angle[1]); + msg.yaw = math::degrees(mount_orientation.attitude_euler_angle[2]); mavlink_msg_mount_orientation_send_struct(_mavlink->get_channel(), &msg);