From a180d836ae93d33203236a784240555189705b4f Mon Sep 17 00:00:00 2001
From: bsongis <bsongis@8db61ce9-5e8f-94c8-fa6b-1d1c8bcca7d0>
Date: Sun, 4 Mar 2012 17:54:52 +0000
Subject: [PATCH] GPS distance now ok on simu / c9x

---
 src/frsky.cpp | 18 ++++++++++--------
 1 file changed, 10 insertions(+), 8 deletions(-)

diff --git a/src/frsky.cpp b/src/frsky.cpp
index 7873904f1..fb3acf40e 100644
--- a/src/frsky.cpp
+++ b/src/frsky.cpp
@@ -610,13 +610,6 @@ void resetTelemetry()
   memset(frskyTelemetry, 0, sizeof(frskyTelemetry));
   memset(frskyRSSI, 0, sizeof(frskyRSSI));
 
-#ifdef SIMU
-  frskyHubData.gpsLatitude_bp = 4401;
-  frskyHubData.gpsLatitude_ap = 7710;
-  frskyHubData.gpsLongitude_bp = 1006;
-  frskyHubData.gpsLongitude_ap = 8872;
-#endif
-
 #if defined(FRSKY_HUB) || defined(WS_HOW_HIGH)
   frskyHubData.baroAltitudeOffset = -frskyHubData.baroAltitude_bp;
 #endif
@@ -639,11 +632,20 @@ void resetTelemetry()
   frskyTelemetry[0].set(120);
   frskyRSSI[0].set(75);
   frskyHubData.fuelLevel = 75;
+
+  frskyHubData.gpsFix = 1;
+  frskyHubData.gpsLatitude_bp = 4401;
+  frskyHubData.gpsLatitude_ap = 7710;
+  frskyHubData.gpsLongitude_bp = 1006;
+  frskyHubData.gpsLongitude_ap = 8872;
+  getGpsPilotPosition();
+
   frskyHubData.gpsLatitude_bp = 4401;
   frskyHubData.gpsLatitude_ap = 7455;
   frskyHubData.gpsLongitude_bp = 1006;
   frskyHubData.gpsLongitude_ap = 9533;
-  frskyHubData.gpsFix = 1;
+  getGpsDistance();
+
   frskyHubData.cellsCount = 6;
 #endif
 }