Browse Source

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

sbg
ChristophTobler 7 years ago committed by Lorenz Meier
parent
commit
c7cf442e16
  1. 2
      src/modules/ekf2/ekf2_main.cpp

2
src/modules/ekf2/ekf2_main.cpp

@ -864,7 +864,7 @@ void Ekf2::run() @@ -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

Loading…
Cancel
Save