From f461481548b243840fdcb55012bf2e79a013a7bb Mon Sep 17 00:00:00 2001
From: Daniel Agar <daniel@agar.ca>
Date: Sat, 6 Feb 2021 17:07:49 -0500
Subject: [PATCH] Revert "mavlink: ODOMETRY handler accept all other
 estimator_types for now"

This reverts commit b216714d5624368fffa84071c0f6c078e4c9d82d.
---
 src/modules/mavlink/mavlink_receiver.cpp | 9 +++++----
 1 file changed, 5 insertions(+), 4 deletions(-)

diff --git a/src/modules/mavlink/mavlink_receiver.cpp b/src/modules/mavlink/mavlink_receiver.cpp
index ff9fee453f..f73f8a7b88 100644
--- a/src/modules/mavlink/mavlink_receiver.cpp
+++ b/src/modules/mavlink/mavlink_receiver.cpp
@@ -1406,13 +1406,14 @@ MavlinkReceiver::handle_message_odometry(mavlink_message_t *msg)
 			odometry.local_frame = vehicle_odometry_s::LOCAL_FRAME_FRD;
 		}
 
-		if (odom.estimator_type == MAV_ESTIMATOR_TYPE_MOCAP) {
+		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) {
 			_mocap_odometry_pub.publish(odometry);
 
 		} else {
-			// MAV_ESTIMATOR_TYPE_VISION, MAV_ESTIMATOR_TYPE_VIO
-			// publish anything else for now
-			_visual_odometry_pub.publish(odometry);
+			PX4_ERR("Estimator source %u not supported. Unable to publish pose and velocity", odom.estimator_type);
 		}
 
 	} else {