FW Position Controller: set airspeed_valid flag to false if incoming data is not finite

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
This commit is contained in:
Silvan Fuhrer 2023-12-06 09:51:04 +01:00
parent 123c06f2e6
commit 27957e1f2f
1 changed files with 3 additions and 0 deletions

View File

@ -228,6 +228,9 @@ FixedwingPositionControl::airspeed_poll()
_airspeed_eas = airspeed_validated.calibrated_airspeed_m_s; _airspeed_eas = airspeed_validated.calibrated_airspeed_m_s;
_eas2tas = constrain(airspeed_validated.true_airspeed_m_s / airspeed_validated.calibrated_airspeed_m_s, 0.9f, 2.0f); _eas2tas = constrain(airspeed_validated.true_airspeed_m_s / airspeed_validated.calibrated_airspeed_m_s, 0.9f, 2.0f);
} else {
airspeed_valid = false;
} }
} else { } else {