|
|
|
@ -196,8 +196,8 @@ void AP_TECS::_update_speed(void)
@@ -196,8 +196,8 @@ void AP_TECS::_update_speed(void)
|
|
|
|
|
|
|
|
|
|
float EAS2TAS = _baro->get_EAS2TAS(); |
|
|
|
|
_TAS_dem = _EAS_dem * EAS2TAS; |
|
|
|
|
_TASmax = aparm.flybywire_airspeed_max * EAS2TAS; |
|
|
|
|
_TASmin = aparm.flybywire_airspeed_min * EAS2TAS; |
|
|
|
|
_TASmax = aparm.airspeed_max * EAS2TAS; |
|
|
|
|
_TASmin = aparm.airspeed_min * EAS2TAS; |
|
|
|
|
|
|
|
|
|
// Reset states of time since last update is too large
|
|
|
|
|
if (DT > 1.0) { |
|
|
|
@ -211,7 +211,7 @@ void AP_TECS::_update_speed(void)
@@ -211,7 +211,7 @@ void AP_TECS::_update_speed(void)
|
|
|
|
|
// airspeed is not being used and set speed rate to zero
|
|
|
|
|
if (!_ahrs->airspeed_sensor_enabled() || !_ahrs->airspeed_estimate(&_EAS)) { |
|
|
|
|
// If no airspeed available use average of min and max
|
|
|
|
|
_EAS = 0.5f * (aparm.flybywire_airspeed_min + aparm.flybywire_airspeed_max); |
|
|
|
|
_EAS = 0.5f * (aparm.airspeed_min + aparm.airspeed_max); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// Implement a second order complementary filter to obtain a
|
|
|
|
|