diff --git a/src/frsky.cpp b/src/frsky.cpp
index f069ce40e..f7e4625ba 100644
--- a/src/frsky.cpp
+++ b/src/frsky.cpp
@@ -143,11 +143,7 @@ inline void getGpsDistance()
   dist = frskyHubData.distFromEarthAxis * angle / 1000000;
   result += dist*dist;
 
-  if (frskyHubData.baroAltitudeOffset)
-    dist = abs(frskyHubData.baroAltitude_bp);
-  else
-    dist = abs(frskyHubData.gpsAltitude_bp);
-
+  dist = abs(frskyHubData.baroAltitudeOffset ? frskyHubData.baroAltitude_bp : frskyHubData.gpsAltitude_bp);
   result += dist*dist;
 
   frskyHubData.gpsDistance = isqrt32(result);