ekf2: fixed airspeed thr bug

This commit is contained in:
CarlOlsson
2016-06-08 19:48:01 +02:00
committed by tumbili
parent b731a9e96c
commit d66af65a92
+1 -1
View File
@@ -536,7 +536,7 @@ void Ekf2::task_main()
// only set airspeed data if condition for airspeed fusion are met
bool fuse_airspeed = airspeed_updated && !_vehicle_status.is_rotary_wing
&& _arspFusionThreshold.get() <= airspeed.true_airspeed_m_s;
&& _arspFusionThreshold.get() <= airspeed.true_airspeed_m_s && _arspFusionThreshold.get() >= 0.1f;
if (fuse_airspeed) {
float eas2tas = airspeed.true_airspeed_m_s / airspeed.indicated_airspeed_m_s;