telemetry: fix distance_sensor unit

The scaling was wrong. Signed-off-by: Julian Oes <julian@oes.ch>
mavlink · Jan 30, 2023 · 135a7ed · 135a7ed
1 parent bec9d6f
commit 135a7ed
Showing 1 changed file with 6 additions and 3 deletions.
diff --git a/src/mavsdk/plugins/telemetry/telemetry_impl.cpp b/src/mavsdk/plugins/telemetry/telemetry_impl.cpp
@@ -1437,9 +1437,12 @@ void TelemetryImpl::process_distance_sensor(const mavlink_message_t& message)
 
     Telemetry::DistanceSensor distance_sensor_struct{};
 
-    distance_sensor_struct.minimum_distance_m = distance_sensor_msg.min_distance;
-    distance_sensor_struct.maximum_distance_m = distance_sensor_msg.max_distance;
-    distance_sensor_struct.current_distance_m = distance_sensor_msg.current_distance;
+    distance_sensor_struct.minimum_distance_m =
+        static_cast<float>(distance_sensor_msg.min_distance) * 0.01f; // cm to m
+    distance_sensor_struct.maximum_distance_m =
+        static_cast<float>(distance_sensor_msg.max_distance) * 0.01f; // cm to m
+    distance_sensor_struct.current_distance_m =
+        static_cast<float>(distance_sensor_msg.current_distance) * 0.01f; // cm to m
 
     set_distance_sensor(distance_sensor_struct);