diff --git a/radio/src/telemetry/telemetry_sensors.cpp b/radio/src/telemetry/telemetry_sensors.cpp index c321cb8de..64544b90f 100644 --- a/radio/src/telemetry/telemetry_sensors.cpp +++ b/radio/src/telemetry/telemetry_sensors.cpp @@ -93,6 +93,12 @@ void TelemetryItem::setValue(const TelemetrySensor & sensor, int32_t val, uint32 newVal = 0; } else if (unit == UNIT_GPS_LATITUDE) { +#if defined(INTERNAL_GPS) + if (gpsData.fix) { + pilotLatitude = gpsData.latitude; + distFromEarthAxis = getDistFromEarthAxis(pilotLatitude); + } +#endif if (!pilotLatitude) { pilotLatitude = newVal; distFromEarthAxis = getDistFromEarthAxis(newVal); @@ -102,6 +108,11 @@ void TelemetryItem::setValue(const TelemetrySensor & sensor, int32_t val, uint32 return; } else if (unit == UNIT_GPS_LONGITUDE) { +#if defined(INTERNAL_GPS) + if (gpsData.fix) { + pilotLongitude = gpsData.longitude; + } +#endif if (!pilotLongitude) { pilotLongitude = newVal; }