aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_Baro: Avoid returning 0.0f for EAS2TAS

Browse Source
This commit is contained in:
Michael du Breuil 2018-11-05 16:14:21 -07:00 committed by Andrew Tridgell
parent 72440e2af3
commit c712e926d7
1 changed files with 5 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
libraries/AP_Baro/AP_Baro.cpp
View File

@ -319,7 +319,11 @@ float AP_Baro::get_EAS2TAS(void)
// provides a more consistent reading then trying to estimate a complete // provides a more consistent reading then trying to estimate a complete
// ISA model atmosphere // ISA model atmosphere
float tempK = get_ground_temperature() + C_TO_KELVIN - ISA_LAPSE_RATE * altitude; float tempK = get_ground_temperature() + C_TO_KELVIN - ISA_LAPSE_RATE * altitude;
_EAS2TAS = safe_sqrt(SSL_AIR_DENSITY / ((float)get_pressure() / (ISA_GAS_CONSTANT * tempK))); const float eas2tas_squared = SSL_AIR_DENSITY / ((float)get_pressure() / (ISA_GAS_CONSTANT * tempK));
if (!is_positive(eas2tas_squared)) {
return 1.0;
}
_EAS2TAS = sqrtf(eas2tas_squared);
_last_altitude_EAS2TAS = altitude; _last_altitude_EAS2TAS = altitude;
return _EAS2TAS; return _EAS2TAS;
} }