diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index d3a46c9d2b..1da00c9e2c 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -749,11 +749,8 @@ then
 	# Lidar-Lite on I2C
 	if param compare SENS_EN_LL40LS 2
 	then
-		if pwm_input start
+		if ll40ls start i2c
 		then
-			if ll40ls start i2c
-			then
-			fi
 		fi
 	fi