diff --git a/ROMFS/px4fmu_common/init.d/rc.sensors b/ROMFS/px4fmu_common/init.d/rc.sensors
index 2ba69ed463..3d9d21cd05 100644
--- a/ROMFS/px4fmu_common/init.d/rc.sensors
+++ b/ROMFS/px4fmu_common/init.d/rc.sensors
@@ -224,10 +224,11 @@ then
 	# Internal SPI bus BMI055_ACC
 	if bmi055 -A start
 	then
-		# Internal SPI bus BMI055_GYR
-		if bmi055 -G start
-		then
-		fi
+	fi
+
+	# Internal SPI bus BMI055_GYR
+	if bmi055 -G start
+	then
 	fi
 
 	# expansion i2c used for BMM150 rotated by 90deg