From 27957e1f2f9bedcabd17be7defbf6804ee8c5df7 Mon Sep 17 00:00:00 2001
From: Silvan Fuhrer <silvan@auterion.com>
Date: Wed, 6 Dec 2023 09:51:04 +0100
Subject: [PATCH] FW Position Controller: set airspeed_valid flag to false if
 incoming data is not finite

Signed-off-by: Silvan Fuhrer <silvan@auterion.com>
---
 src/modules/fw_pos_control/FixedwingPositionControl.cpp | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/src/modules/fw_pos_control/FixedwingPositionControl.cpp b/src/modules/fw_pos_control/FixedwingPositionControl.cpp
index c82215cabb..2762707587 100644
--- a/src/modules/fw_pos_control/FixedwingPositionControl.cpp
+++ b/src/modules/fw_pos_control/FixedwingPositionControl.cpp
@@ -228,6 +228,9 @@ FixedwingPositionControl::airspeed_poll()
 			_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);
+
+		} else {
+			airspeed_valid = false;
 		}
 
 	} else {