mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-11-01 06:51:37 +08:00
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:
@@ -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();
|
||||
|
||||
Reference in New Issue
Block a user