GNSS yaw: use NIS sequence to detect bias in state

A constant large value in the (signed) normalized innovation test ratio is a sign
of bias in the state estimate. This metric can be used to trigger a
covariance boost or reset
This commit is contained in:
bresch
2021-08-05 11:10:02 +02:00
committed by Mathieu Bresciani
parent 3fe04a91f6
commit 4ebfbc6eab
3 changed files with 17 additions and 14 deletions
@@ -328,6 +328,7 @@ protected:
// innovation consistency check monitoring ratios
float _yaw_test_ratio{}; // yaw innovation consistency check ratio
AlphaFilter<float>_yaw_signed_test_ratio_lpf{0.1f}; // average signed test ratio used to detect a bias in the state
Vector3f _mag_test_ratio{}; // magnetometer XYZ innovation consistency check ratios
Vector2f _gps_vel_test_ratio{}; // GPS velocity innovation consistency check ratios
Vector2f _gps_pos_test_ratio{}; // GPS position innovation consistency check ratios