fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-28 07:54:06 +08:00
Code Issues Packages Projects Releases Wiki Activity

EKF2: Fix GPS blending time jitter

Browse Source
This commit is contained in:
CarlOlsson 2020-02-25 14:48:06 +01:00 committed by Beat Küng
parent a38b167614
commit 7e00dcd382
1 changed files with 1 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
src/modules/ekf2/ekf2_main.cpp
View File

@ -1833,7 +1833,7 @@ bool Ekf2::blend_gps_data()
float dt_min = 0.3f;
for (uint8_t i = 0; i < GPS_MAX_RECEIVERS; i++) {
float raw_dt = 0.001f * (float)(_gps_state[i].time_usec - _time_prev_us[i]);
float raw_dt = 1e-6f * (float)(_gps_state[i].time_usec - _time_prev_us[i]);
if (raw_dt > 0.0f && raw_dt < 0.3f) {
_gps_dt[i] = 0.1f * raw_dt + 0.9f * _gps_dt[i];