Optimize rc shell

ROMFS/px4fmu_common/init.d/rc.sensors

@@ -83,9 +83,10 @@ then
 		then
 		fi
 	fi
-else
-	if ver hwcmp PX4FMU_V4
-	then
+fi
+
+if ver hwcmp PX4FMU_V4
+then
 	# External I2C bus
 	if hmc5883 -C -T -X start
 	then
@@ -105,26 +106,10 @@ else
 	if mpu9250 -R 2 start
 	then
 	fi
-	else
-		if ver hwcmp MINDPX_V2
-		then
-			if mpu6500 start
-			then
-			fi
+fi
 
-			if lsm303d start
-			then
-			fi
-
-			if l3gd20 start
-			then
-			fi
-
-			# External I2C bus
-			if hmc5883 -C -T -X start
-			then
-			fi
-		else
+if ver hwcmp PX4FMU_V1
+then
 	# FMUv1
 	if mpu6000 start
 	then
@@ -154,7 +139,25 @@ else
 			fi
 		fi
 	fi
+fi
+
+if ver hwcmp MINDPX_V2
+then
+	if mpu6500 start
+	then
 	fi
+
+	if lsm303d start
+	then
+	fi
+
+	if l3gd20 start
+	then
+	fi
+
+	# External I2C bus
+	if hmc5883 -C -T -X start
+	then
 	fi
 fi
 

ROMFS/px4fmu_common/init.d/rcS

@@ -815,12 +815,6 @@ fi
 # XXX potentially unset all script variables.
 unset TUNE_ERR
 
-#if ver hwcmp MINDPX_V2
-#then
-#	start sonnar
-#	hc_sr04 start
-#fi
-
 # Boot is complete, inform MAVLink app(s) that the system is now fully up and running
 mavlink boot_complete