diff --git a/src/modules/mavlink/mavlink_messages.cpp b/src/modules/mavlink/mavlink_messages.cpp
index c8f0f6da0b..cc00fc69b8 100644
--- a/src/modules/mavlink/mavlink_messages.cpp
+++ b/src/modules/mavlink/mavlink_messages.cpp
@@ -2234,7 +2234,7 @@ protected:
 
 			switch (dist_sensor.type) {
 			case MAV_DISTANCE_SENSOR_ULTRASOUND:
-				msg.type = MAV_DISTANCE_SENSOR_LASER;
+				msg.type = MAV_DISTANCE_SENSOR_ULTRASOUND;
 				break;
 
 			case MAV_DISTANCE_SENSOR_LASER: