diff --git a/src/uas/UAS.cc b/src/uas/UAS.cc
index cb3ca6eff41e0e9a8f802faf0ba5650b301d6a5f..bcc64ac982dd4e953dd21a414199ca506ad7f417 100644
--- a/src/uas/UAS.cc
+++ b/src/uas/UAS.cc
@@ -804,7 +804,7 @@ void UAS::receiveMessage(LinkInterface* link, mavlink_message_t message)
 
                 if (!globalEstimatorActive && (vel < 1000000) && !isnan(vel) && !isinf(vel))
                 {
-                    emit speedChanged(this, (double)pos.v, 0.0, 0.0, time);
+                    emit speedChanged(this, vel, 0.0, 0.0, time);
                 }
                 else
                 {