ekf2: use ev eph/v for noise parameter if bigger than noise param

This commit is contained in:
ChristophTobler
2018-01-15 11:11:56 +01:00
committed by Lorenz Meier
parent 1d59d89282
commit c7cf442e16
+1 -1
View File
@@ -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