fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-16 02:13:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

Update external vision interface (#13989)

Browse Source 
* Update external vision interface

* Update ECL Version
This commit is contained in:
kritz
2020-01-23 15:36:08 +01:00
committed by Mathieu Bresciani
parent 9554f8f98b
commit 47cab3dba5
2 changed files with 5 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/ecl
+1 -1
Submodule src/lib/ecl updated: ed916c8006...de33885658
src/modules/ekf2/ekf2_main.cpp
+4 -3
View File
@@ -1095,10 +1095,10 @@ void Ekf2::Run()
if (_ev_odom_sub.updated()) {
new_ev_data_received = true;
// copy both attitude & position, we need both to fill a single ext_vision_message
// copy both attitude & position, we need both to fill a single extVisionSample
_ev_odom_sub.copy(&_ev_odom);
ext_vision_message ev_data;
extVisionSample ev_data;
// check for valid velocity data
if (PX4_ISFINITE(_ev_odom.vx) && PX4_ISFINITE(_ev_odom.vy) && PX4_ISFINITE(_ev_odom.vz)) {
@@ -1158,7 +1158,8 @@ void Ekf2::Run()
}
// use timestamp from external computer, clocks are synchronized when using MAVROS
_ekf.setExtVisionData(_ev_odom.timestamp, &ev_data);
ev_data.time_us = _ev_odom.timestamp;
_ekf.setExtVisionData(ev_data);
ekf2_timestamps.visual_odometry_timestamp_rel = (int16_t)((int64_t)_ev_odom.timestamp / 100 -
(int64_t)ekf2_timestamps.timestamp / 100);