X-Git-Url: https://git.gag.com/?a=blobdiff_plain;ds=sidebyside;f=src%2Fdrivers%2Fao_gps_skytraq.c;h=066df6fff628a39b0680b69e8cf1d34a27b1fe84;hb=47e62bb26984f6c84660c1d0451f77c2d6ad7e5a;hp=944a37f9b38400a05ccc3d2a437f332141af8a79;hpb=998eae61ecf56dd6ead4ec6ad82c952ae84170df;p=fw%2Faltos

diff --git a/src/drivers/ao_gps_skytraq.c b/src/drivers/ao_gps_skytraq.c
index 944a37f9..066df6ff 100644
--- a/src/drivers/ao_gps_skytraq.c
+++ b/src/drivers/ao_gps_skytraq.c
@@ -278,16 +278,17 @@ ao_nmea_gga(void)
 
 	ao_gps_lexchar();
 	i = ao_gps_decimal(0xff);
-	if (i <= 50) {
-		i = (uint8_t) 5 * i;
+	if (i <= 25) {
+		i = (uint8_t) 10 * i;
 		if (ao_gps_char == '.')
-			i = (i + ((uint8_t) ao_gps_decimal(1) >> 1));
+			i = (i + ((uint8_t) ao_gps_decimal(1)));
 	} else
 		i = 255;
 	ao_gps_next.hdop = i;
 	ao_gps_skip_field();
 
-	ao_gps_next.altitude = ao_gps_decimal(0xff);
+	AO_TELEMETRY_LOCATION_SET_ALTITUDE(&ao_gps_next, ao_gps_decimal(0xff));
+
 	ao_gps_skip_field();	/* skip any fractional portion */
 
 	ao_nmea_finish();