Browse Source

EKF: Use consistent validity definition for global position reporting

master
Paul Riseborough 7 years ago committed by Daniel Agar
parent
commit
fdabb9277f
No known key found for this signature in database
GPG Key ID: FD3CBA98017A69DE
  1. 6
      EKF/ekf_helper.cpp

6
EKF/ekf_helper.cpp

@ -988,12 +988,8 @@ void Ekf::get_ekf_gpos_accuracy(float *ekf_eph, float *ekf_epv, bool *dead_recko @@ -988,12 +988,8 @@ void Ekf::get_ekf_gpos_accuracy(float *ekf_eph, float *ekf_epv, bool *dead_recko
// TODO - allow for baro drift in vertical position error
float hpos_err;
float vpos_err;
bool vel_pos_aiding = (_control_status.flags.gps ||
_control_status.flags.opt_flow ||
_control_status.flags.ev_pos ||
(_control_status.flags.fuse_beta && _control_status.flags.fuse_aspd));
if (vel_pos_aiding && _NED_origin_initialised) {
if (global_position_is_valid()) {
hpos_err = sqrtf(P[7][7] + P[8][8] + sq(_gps_origin_eph));
vpos_err = sqrtf(P[9][9] + sq(_gps_origin_epv));

Loading…
Cancel
Save