diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index 0c1539df9bc2dfd1340baa9f0fc2d0008fe15d06..ac222ac9457bcee6e6f65f8f4f57d3312b65a528 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -554,12 +554,16 @@ then
 
 		if ver hwcmp AEROFC_V1
 		then
-			# Only start mavlink if the Benewake TFMini isn't being used
+			set MAVLINK_F "-r 1200 -d /dev/ttyS3"
+
+			# Only start mavlink if the Benewake TFMini or LeddarOne isn't being used
 			if param greater SENS_EN_TFMINI 0
 			then
 				set MAVLINK_F none
-			else
-				set MAVLINK_F "-r 1200 -d /dev/ttyS3"
+			fi
+			if param greater SENS_EN_LEDDAR1 0
+			then
+				set MAVLINK_F none				
 			fi
 		fi