From b216714d5624368fffa84071c0f6c078e4c9d82d Mon Sep 17 00:00:00 2001 From: Daniel Agar Date: Sat, 6 Feb 2021 15:45:58 -0500 Subject: [PATCH] mavlink: ODOMETRY handler accept all other estimator_types for now --- src/modules/mavlink/mavlink_receiver.cpp | 9 ++++----- 1 file changed, 4 insertions(+), 5 deletions(-) diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp index f73f8a7b88..ff9fee453f 100644 --- a/src/modules/mavlink/mavlink_receiver.cpp +++ b/src/modules/mavlink/mavlink_receiver.cpp @@ -1406,14 +1406,13 @@ MavlinkReceiver::handle_message_odometry(mavlink_message_t *msg) odometry.local_frame = vehicle_odometry_s::LOCAL_FRAME_FRD; } - if (odom.estimator_type == MAV_ESTIMATOR_TYPE_VISION || odom.estimator_type == MAV_ESTIMATOR_TYPE_VIO) { - _visual_odometry_pub.publish(odometry); - - } else if (odom.estimator_type == MAV_ESTIMATOR_TYPE_MOCAP) { + if (odom.estimator_type == MAV_ESTIMATOR_TYPE_MOCAP) { _mocap_odometry_pub.publish(odometry); } else { - PX4_ERR("Estimator source %u not supported. Unable to publish pose and velocity", odom.estimator_type); + // MAV_ESTIMATOR_TYPE_VISION, MAV_ESTIMATOR_TYPE_VIO + // publish anything else for now + _visual_odometry_pub.publish(odometry); } } else {