Altitude may now be negative (because offset is added each time we receive a new value)

2012-03-11 14:04:55 +00:00
parent 74f5cba651
commit b6de4538fb
1 changed files with 5 additions and 1 deletions
@@ -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);