ROMFS: aerofc: Do not start MAVLink in telemetry if LeddarOne is in use

7 years ago · 10df6729f3
1 changed files with 7 additions and 3 deletions
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@ -554,12 +554,16 @@ then
				@@ -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