|
|
@ -98,7 +98,6 @@ public: |
|
|
|
void set_wind_estimator_beta_noise(float beta_var) { _wind_estimator.set_beta_noise(beta_var); } |
|
|
|
void set_wind_estimator_beta_noise(float beta_var) { _wind_estimator.set_beta_noise(beta_var); } |
|
|
|
void set_wind_estimator_tas_gate(uint8_t gate_size) |
|
|
|
void set_wind_estimator_tas_gate(uint8_t gate_size) |
|
|
|
{ |
|
|
|
{ |
|
|
|
_tas_gate = gate_size; |
|
|
|
|
|
|
|
_wind_estimator.set_tas_gate(gate_size); |
|
|
|
_wind_estimator.set_tas_gate(gate_size); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
@ -147,7 +146,6 @@ private: |
|
|
|
static constexpr uint64_t DATA_STUCK_TIMEOUT{2_s}; ///< timeout after which data stuck check triggers when data is flat
|
|
|
|
static constexpr uint64_t DATA_STUCK_TIMEOUT{2_s}; ///< timeout after which data stuck check triggers when data is flat
|
|
|
|
|
|
|
|
|
|
|
|
// states of innovation check
|
|
|
|
// states of innovation check
|
|
|
|
float _tas_gate{1.0f}; ///< gate size of airspeed innovation (to calculate tas_test_ratio)
|
|
|
|
|
|
|
|
bool _innovations_check_failed{false}; ///< true when airspeed innovations have failed consistency checks
|
|
|
|
bool _innovations_check_failed{false}; ///< true when airspeed innovations have failed consistency checks
|
|
|
|
float _tas_innov_threshold{1.0}; ///< innovation error threshold for triggering innovation check failure
|
|
|
|
float _tas_innov_threshold{1.0}; ///< innovation error threshold for triggering innovation check failure
|
|
|
|
float _tas_innov_integ_threshold{-1.0}; ///< integrator innovation error threshold for triggering innovation check failure
|
|
|
|
float _tas_innov_integ_threshold{-1.0}; ///< integrator innovation error threshold for triggering innovation check failure
|
|
|
|