From 489ee587738417c9699acfad6a2fd41f573d299c Mon Sep 17 00:00:00 2001
From: David Sidrane <david_s5@nscdg.com>
Date: Fri, 16 Dec 2016 14:44:24 -1000
Subject: [PATCH] px4fmu-v5 starts ICM 20602 and ICM 20689

---
 ROMFS/px4fmu_common/init.d/rc.sensors | 5 ++---
 1 file changed, 2 insertions(+), 3 deletions(-)

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