mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-17 15:43:34 +08:00
ekf2: use ev eph/v for noise parameter if bigger than noise param
This commit is contained in:
committed by
Lorenz Meier
parent
1d59d89282
commit
c7cf442e16
@@ -864,7 +864,7 @@ void Ekf2::run()
|
||||
ev_data.quat = q;
|
||||
|
||||
// position measurement error from parameters. TODO : use covariances from topic
|
||||
ev_data.posErr = _ev_pos_noise.get();
|
||||
ev_data.posErr = fmaxf(_ev_pos_noise.get(), fmaxf(ev_pos.eph, ev_pos.epv));
|
||||
ev_data.angErr = _ev_ang_noise.get();
|
||||
|
||||
// use timestamp from external computer, clocks are synchronized when using MAVROS
|
||||
|
||||
Reference in New Issue
Block a user