diff --git a/src/uas/UAS.cc b/src/uas/UAS.cc
index 653dc418b54ad9e9992270c33efee53ae2e066aa..b4f7026aed974a2a76dffc6f32b00cb9447c9bbd 100644
--- a/src/uas/UAS.cc
+++ b/src/uas/UAS.cc
@@ -316,7 +316,7 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
             {
                 mavlink_position_t pos;
                 mavlink_msg_position_decode(&message, &pos);
-                quint64 time = pos.msec/1000;
+                quint64 time = pos.usec/1000;
                 if (time == 0)
                 {
                     time = MG::TIME::getGroundTimeNow();