From b6de4538fb767f5620f8c62fcd0ec3295c20ea64 Mon Sep 17 00:00:00 2001
From: bsongis <bsongis@8db61ce9-5e8f-94c8-fa6b-1d1c8bcca7d0>
Date: Sun, 11 Mar 2012 14:04:55 +0000
Subject: [PATCH] Altitude may now be negative (because offset is added each
 time we receive a new value)

---
 src/frsky.cpp | 6 +++++-
 1 file changed, 5 insertions(+), 1 deletion(-)

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