diff --git a/ROMFS/px4fmu_common/init.d/rc.sensors b/ROMFS/px4fmu_common/init.d/rc.sensors
index 55f63511a7..e462b995d9 100644
--- a/ROMFS/px4fmu_common/init.d/rc.sensors
+++ b/ROMFS/px4fmu_common/init.d/rc.sensors
@@ -325,13 +325,12 @@ fi
 if ver hwcmp PX4FMU_V5
 then
 	# Internal SPI bus ICM-20602
-	if mpu6000 -R 2 -T 20602 start
+	if mpu6000 -R 2 -s -T 20602 start
 	then
 	fi
 
 	# Internal SPI bus ICM-20689
-# Place holder Need 20689 Support added
-	if mpu6000 -R 2 -T 20608 start
+	if mpu6000 -R 2 -z -T 20689 start
 	then
 	fi