mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-22 11:43:35 +08:00
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:
committed by
Mathieu Bresciani
parent
3fe04a91f6
commit
4ebfbc6eab
@@ -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
|
||||
|
||||
Reference in New Issue
Block a user