diff --git a/ROMFS/px4fmu_common/init.d/rc.sensors b/ROMFS/px4fmu_common/init.d/rc.sensors
index d9cdfa5dc0..69d9e158dc 100644
--- a/ROMFS/px4fmu_common/init.d/rc.sensors
+++ b/ROMFS/px4fmu_common/init.d/rc.sensors
@@ -115,17 +115,6 @@ if px4flow start &
 then
 fi
 
-if param compare SENS_EN_LL40LS 1
-then
-	if pwm_input start
-	then
-	fi
-	
-	if ll40ls start pwm
-	then
-	fi
-fi
-
 #
 # Start sensors
 #
diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index 0a4887a639..7c112d7386 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -451,6 +451,17 @@ then
 		fi
 	fi
 
+	# Start sensors depending on the interface being up
+	if param compare SENS_EN_LL40LS 1
+	then
+		if pwm_input start
+		then
+			if ll40ls start pwm
+			then
+			fi
+		fi
+	fi
+
 	if [ $MAVLINK_F == default ]
 	then
 		# Normal mode, use baudrate 57600 (default) and data rate 1000 bytes/s