fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-30 07:43:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

Revert "mavlink: ODOMETRY handler accept all other estimator_types for now"

Browse Source 
This reverts commit b216714d56.
This commit is contained in:
Daniel Agar
2021-02-07 09:51:05 -05:00
parent b216714d56
commit f461481548
1 changed files with 5 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mavlink/mavlink_receiver.cpp
+5 -4
View File
@@ -1406,13 +1406,14 @@ MavlinkReceiver::handle_message_odometry(mavlink_message_t *msg)
odometry.local_frame = vehicle_odometry_s::LOCAL_FRAME_FRD; 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); _mocap_odometry_pub.publish(odometry);
} else { } else {
// MAV_ESTIMATOR_TYPE_VISION, MAV_ESTIMATOR_TYPE_VIO PX4_ERR("Estimator source %u not supported. Unable to publish pose and velocity", odom.estimator_type);
// publish anything else for now
_visual_odometry_pub.publish(odometry);
} }
} else { } else {