From 538b8d9913b14ab923b5ccbf2c45af197855c6b6 Mon Sep 17 00:00:00 2001
From: Florian Achermann <florian.achermann@mavt.ethz.ch>
Date: Tue, 8 Jun 2021 14:57:35 +0200
Subject: [PATCH] Add booting the si7210 sensors to rc.sensors

---
 ROMFS/px4fmu_common/init.d/rc.sensors | 51 +++++++++++++++++++++++++++
 1 file changed, 51 insertions(+)

diff --git a/ROMFS/px4fmu_common/init.d/rc.sensors b/ROMFS/px4fmu_common/init.d/rc.sensors
index 8247025f8d..af52b6826d 100644
--- a/ROMFS/px4fmu_common/init.d/rc.sensors
+++ b/ROMFS/px4fmu_common/init.d/rc.sensors
@@ -114,6 +114,57 @@ then
 	adis16448 -S start
 fi
 
+# Hall effect sensors si7210
+# Potentially remove the -k option if possible and improve the startup if possible
+if param greater CAL_AV_AOA_ID -1
+then
+	set AOA_I2C_ID 0
+	if param compare CAL_AV_AOA_ID 48
+	then
+		set AOA_I2C_ID 48
+	fi
+	if param compare CAL_AV_AOA_ID 49
+	then
+		set AOA_I2C_ID 49
+	fi
+	if param compare CAL_AV_AOA_ID 50
+	then
+		set AOA_I2C_ID 50
+	fi
+	if param compare CAL_AV_AOA_ID 51
+	then
+		set AOA_I2C_ID 51
+	fi
+
+	si7210 start -X -k -a ${AOA_I2C_ID}
+	unset AOA_I2C_ID
+fi
+
+if param greater CAL_AV_SLIP_ID -1
+then
+	set SLIP_I2C_ID 0
+	if param compare CAL_AV_SLIP_ID 48
+	then
+		set SLIP_I2C_ID 48
+	fi
+	if param compare CAL_AV_SLIP_ID 49
+	then
+		set SLIP_I2C_ID 49
+	fi
+	if param compare CAL_AV_SLIP_ID 50
+	then
+		set SLIP_I2C_ID 50
+	fi
+	if param compare CAL_AV_SLIP_ID 51
+	then
+		set SLIP_I2C_ID 51
+	fi
+
+	si7210 start -X -k -a ${SLIP_I2C_ID}
+	unset SLIP_I2C_ID
+fi
+
+
 # probe for optional external I2C devices
 if param compare SENS_EXT_I2C_PRB 1
 then