From 7d712a4cd1823fed21d6cdf39b60341382fd121c Mon Sep 17 00:00:00 2001
From: Lorenz Meier <lm@inf.ethz.ch>
Date: Sat, 3 Jan 2015 17:47:58 +0100
Subject: Test image ROMFS: Start all sensors

---
 ROMFS/px4fmu_test/init.d/rcS | 20 ++++++++++++++++++++
 1 file changed, 20 insertions(+)

diff --git a/ROMFS/px4fmu_test/init.d/rcS b/ROMFS/px4fmu_test/init.d/rcS
index ef032de5c..40b3500e0 100644
--- a/ROMFS/px4fmu_test/init.d/rcS
+++ b/ROMFS/px4fmu_test/init.d/rcS
@@ -97,6 +97,26 @@ else
 	set unit_test_failure_list "${unit_test_failure_list} commander_tests"
 fi
 
+if hmc5883 -I start
+then
+	# This is an FMUv3
+	echo "FMUv3"
+	ms5611 start
+	mpu6000 -X start
+	mpu6000 start
+	lsm303d -X start
+	l3gd20 -X start
+	echo "EVALUATION ONLY SENSORS (not used in production)"
+	ms5611 -X start
+else
+	# This is an FMUv1 or FMUv2
+	echo "FMUv2 (or FMUv3 where 'hmc5883 -I start' failed)"
+	ms5611 start
+	mpu6000 start
+	lsm303d start
+	l3gd20 start
+fi
+
 if [ $unit_test_failure == 0 ]
 then
 	echo
-- 
cgit v1.2.3