Feature: VIO: add ODOMETRY stream (#11084)

* mavlink_messages: remove LOCAL_POSITION_NED_COV stream

* mavlink_messages.cpp: add ODOMETRY stream

* add MAV_ODOM_LP parameter to activate odometry loopback

* EKF2: add vehicle_odometry publisher

* Replace VISION_POSITION_ESTIMATE loopback with ODOMETRY

* LPE: add vehicle_odometry publisher

* set vehicle_odometry local_frame field

* mavlink_messages.cpp: ODOMETRY frame_id depends on MAV_ODOM_LP
This commit is contained in:
Nuno Marques
2018-12-21 12:54:04 -05:00
committed by James Goppert
parent b3018646d5
commit cfd1be584e
10 changed files with 250 additions and 115 deletions
+2
View File
@@ -45,6 +45,7 @@
#include "mavlink_main.h"
MavlinkStream::MavlinkStream(Mavlink *mavlink) :
ModuleParams(nullptr),
_mavlink(mavlink)
{
_last_sent = hrt_absolute_time();
@@ -57,6 +58,7 @@ int
MavlinkStream::update(const hrt_abstime &t)
{
update_data();
ModuleParams::updateParams();
// If the message has never been sent before we want
// to send it immediately and can return right away