mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-04 05:05:19 +08:00
AirspeedValidator: increase max update step size of tas_scale_validated from 1% to 5%
Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
committed by
Mathieu Bresciani
parent
a20483ed11
commit
638eff426a
@@ -145,9 +145,9 @@ AirspeedValidator::update_CAS_scale_validated(bool lpos_valid, const matrix::Vec
|
|||||||
// check passes if the average airspeed with the scale applied is closer to groundspeed than without
|
// check passes if the average airspeed with the scale applied is closer to groundspeed than without
|
||||||
if (fabsf(TAS_to_grounspeed_error_new) < fabsf(TAS_to_grounspeed_error_current)) {
|
if (fabsf(TAS_to_grounspeed_error_new) < fabsf(TAS_to_grounspeed_error_current)) {
|
||||||
|
|
||||||
// constrain the scale update to max 0.01 at a time
|
// constrain the scale update to max 0.05 at a time
|
||||||
const float new_scale_constrained = math::constrain(_wind_estimator.get_tas_scale(), _CAS_scale_validated - 0.01f,
|
const float new_scale_constrained = math::constrain(_wind_estimator.get_tas_scale(), _CAS_scale_validated - 0.05f,
|
||||||
_CAS_scale_validated + 0.01f);
|
_CAS_scale_validated + 0.05f);
|
||||||
|
|
||||||
_CAS_scale_validated = new_scale_constrained;
|
_CAS_scale_validated = new_scale_constrained;
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user