diff --git a/libraries/AP_GPS/AP_GPS_MTK.cpp b/libraries/AP_GPS/AP_GPS_MTK.cpp index 8defd43b8e..60bc8b6ece 100644 --- a/libraries/AP_GPS/AP_GPS_MTK.cpp +++ b/libraries/AP_GPS/AP_GPS_MTK.cpp @@ -127,8 +127,8 @@ AP_GPS_MTK::parse_gps(void) switch(id){ //Checking the UBX ID case 0x05: // ID Custom - latitude = _swapl(&buffer[0]); - longitude = _swapl(&buffer[4]); + latitude = _swapl(&buffer[0]) * 10; + longitude = _swapl(&buffer[4]) * 10; altitude = _swapl(&buffer[8]); speed_3d = ground_speed = _swapl(&buffer[12]); ground_course = _swapl(&buffer[16]) / 10000; diff --git a/libraries/AP_GPS/examples/GPS_UBLOX_test/GPS_UBLOX_test.pde b/libraries/AP_GPS/examples/GPS_UBLOX_test/GPS_UBLOX_test.pde index e88251ac7d..43eb239495 100644 --- a/libraries/AP_GPS/examples/GPS_UBLOX_test/GPS_UBLOX_test.pde +++ b/libraries/AP_GPS/examples/GPS_UBLOX_test/GPS_UBLOX_test.pde @@ -42,7 +42,7 @@ void loop() Serial.print(" GSP:"); Serial.print(gps.ground_speed / 100.0); Serial.print(" COG:"); - Serial.print(gps.ground_course / 100, DEC); + Serial.print(gps.ground_course / 100.0, DEC); Serial.print(" SAT:"); Serial.print(gps.num_sats, DEC); Serial.print(" FIX:");