From 2ce8056b8f2d9d3c2489e9f11f3a1edc9b14fb0e Mon Sep 17 00:00:00 2001 From: Paul Riseborough Date: Fri, 27 May 2016 11:45:04 +1000 Subject: [PATCH] mavlink: publish values for vision system errors Sets zero values as a placeholder until mavlink can be updated. --- src/modules/mavlink/mavlink_receiver.cpp | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp index 5ee0312fdc..557c5caefd 100644 --- a/src/modules/mavlink/mavlink_receiver.cpp +++ b/src/modules/mavlink/mavlink_receiver.cpp @@ -967,6 +967,10 @@ MavlinkReceiver::handle_message_vision_position_estimate(mavlink_message_t *msg) vision_position.q[2] = q(2); vision_position.q[3] = q(3); + // TODO fix this + vision_position.pos_err = 0.0f; + vision_position.ang_err = 0.0f; + if (_vision_position_pub == nullptr) { _vision_position_pub = orb_advertise(ORB_ID(vision_position_estimate), &vision_position);