From 4ea85273048862fe6dbb4d457372214a04b8f165 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Igor=20Mi=C5=A1i=C4=87?= <igy1000mb@gmail.com>
Date: Thu, 27 Jan 2022 13:28:29 +0100
Subject: [PATCH] board/fmu-v5x: reverse order for start boards to shorten the
 command

---
 boards/px4/fmu-v5x/init/rc.board_sensors | 46 ++++++++++++------------
 1 file changed, 23 insertions(+), 23 deletions(-)

diff --git a/boards/px4/fmu-v5x/init/rc.board_sensors b/boards/px4/fmu-v5x/init/rc.board_sensors
index 6934355226..836a7e2ec8 100644
--- a/boards/px4/fmu-v5x/init/rc.board_sensors
+++ b/boards/px4/fmu-v5x/init/rc.board_sensors
@@ -48,30 +48,8 @@ then
 	fi
 fi
 
-if ver hwtypecmp V5X00090000 V5X00090001 V5X00090002 V5X000a0000 V5X000a0001 V5X000a0002 V5X00080000 V5X00080001 V5X00080002 V5X00100001
+if ver hwtypecmp V5X00000000 V5X00000001 V5X00000002 V5X00010000
 then
-	#SKYNODE base fmu board orientation
-
-	if ver hwtypecmp V5X00090000 V5X00090001 V5X000a0000 V5X000a0001 V5X00080000 V5X00080001 V5X00100001
-	then
-		# Internal SPI BMI088
-		bmi088 -A -R 2 -s start
-		bmi088 -G -R 2 -s start
-	else
-		# Internal SPI bus ICM20649
-		icm20649 -s -R 4 start
-	fi
-
-	# Internal SPI bus ICM42688p
-	icm42688p -R 4 -s start
-
-	# Internal SPI bus ICM-20602 (hard-mounted)
-	icm20602 -R 8 -s start
-
-	# Internal magnetometer on I2c
-	bmm150 -I -R 6 start
-
-else
 	#FMUv5Xbase board orientation
 
 	if ver hwtypecmp V5X00000000 V5X00000001
@@ -93,6 +71,28 @@ else
 	# Internal magnetometer on I2c
 	bmm150 -I start
 
+else
+	#SKYNODE base fmu board orientation
+
+	if ver hwtypecmp V5X00090000 V5X00090001 V5X000a0000 V5X000a0001 V5X00080000 V5X00080001 V5X00100001
+	then
+		# Internal SPI BMI088
+		bmi088 -A -R 2 -s start
+		bmi088 -G -R 2 -s start
+	else
+		# Internal SPI bus ICM20649
+		icm20649 -s -R 4 start
+	fi
+
+	# Internal SPI bus ICM42688p
+	icm42688p -R 4 -s start
+
+	# Internal SPI bus ICM-20602 (hard-mounted)
+	icm20602 -R 8 -s start
+
+	# Internal magnetometer on I2c
+	bmm150 -I -R 6 start
+
 fi
 
 # External compass on GPS1/I2C1 (the 3rd external bus): standard Holybro Pixhawk 4 or CUAV V5 GPS/compass puck (with lights, safety button, and buzzer)