EKF: improve detection of bad vert accel data

Improve ability to detect if bad vertical accel data has caused loss of height accuracy by using historical data.
This commit is contained in:
Paul Riseborough
2016-04-22 09:24:04 +10:00
parent 469a7d1711
commit 874558d194
3 changed files with 23 additions and 7 deletions
+3
View File
@@ -240,6 +240,9 @@ private:
float _vert_vel_reset_delta; // increase in vertical position velocity at the last reset(m)
uint64_t _time_vert_vel_reset; // last system time in usec that the vertical velocity state was reset
// imu fault status
uint64_t _time_bad_vert_accel; // last time a bad vertical accel was detected (usec)
// update the real time complementary filter states. This includes the prediction
// and the correction step
void calculateOutputStates();