diff --git a/src/Vehicle/Vehicle.cc b/src/Vehicle/Vehicle.cc
index 3ffb4672f07b5cfbed4c5af77b4691fd905d38bd..8936de6093743a3bfd6f0c9c41d246fef5d0407d 100644
--- a/src/Vehicle/Vehicle.cc
+++ b/src/Vehicle/Vehicle.cc
@@ -560,8 +560,8 @@ void Vehicle::_handleAltitude(mavlink_message_t& message)
 
     _useAltitudeForAltitude = true;
     _useGpsRawIntForAltitude = false;
-    _altitudeRelativeFact.setRawValue(altitude.altitude_relative / 1000.0);
-    _altitudeAMSLFact.setRawValue(altitude.altitude_amsl / 1000.0);
+    _altitudeRelativeFact.setRawValue(altitude.altitude_relative);
+    _altitudeAMSLFact.setRawValue(altitude.altitude_amsl);
 
 }