From 0973f1037ff3d7ed781cb333f00b9d63bc841d80 Mon Sep 17 00:00:00 2001
From: Andres <>
Date: Thu, 1 May 2014 10:40:33 +0200
Subject: [PATCH] OP-1315 (re)added IS_REAL check for CalibratedAirspeed and
 for new calculated airspeed

---
 flight/modules/Airspeed/gps_airspeed.c | 6 +++++-
 1 file changed, 5 insertions(+), 1 deletion(-)

diff --git a/flight/modules/Airspeed/gps_airspeed.c b/flight/modules/Airspeed/gps_airspeed.c
index 91319568e..5486f8161 100644
--- a/flight/modules/Airspeed/gps_airspeed.c
+++ b/flight/modules/Airspeed/gps_airspeed.c
@@ -151,7 +151,11 @@ void gps_airspeedGet(AirspeedSensorData *airspeedData, AirspeedSettingsData *air
 
         // Airspeed magnitude is the ratio between the two difference norms
         float airspeed = sqrtf(normDiffGPS2 / normDiffAttitude2);
-        if (!IS_REAL(airspeed)) {
+        if (!IS_REAL(airspeedData->CalibratedAirspeed)) {
+            airspeedData->CalibratedAirspeed = 0;
+            airspeedData->SensorConnected    = AIRSPEEDSENSOR_SENSORCONNECTED_FALSE;
+            AlarmsSet(SYSTEMALARMS_ALARM_AIRSPEED, SYSTEMALARMS_ALARM_ERROR);
+        } else if (!IS_REAL(airspeed)) {
             airspeedData->CalibratedAirspeed = 0;
             airspeedData->SensorConnected    = AIRSPEEDSENSOR_SENSORCONNECTED_FALSE;
             AlarmsSet(SYSTEMALARMS_ALARM_AIRSPEED, SYSTEMALARMS_ALARM_WARNING);