atlas has 5v sensor sensing

FOME-Tech · Jan 4, 2025 · 9507696 · 9507696
1 parent be29786
commit 9507696
Showing 1 changed file with 23 additions and 8 deletions.
diff --git a/firmware/config/boards/atlas/board_configuration.cpp b/firmware/config/boards/atlas/board_configuration.cpp
@@ -155,14 +155,29 @@ void preHalInit() {
 }
 
 void initBoardSensors() {
-	static LinearFunc mrSenseFunc;
-	static FunctionalSensor mrSenseSensor(SensorType::MainRelayVoltage, MS2NT(100));
+	{
+		static LinearFunc mrSenseFunc;
+		static FunctionalSensor mrSenseSensor(SensorType::MainRelayVoltage, MS2NT(100));
 
-	// 82k high side/10k low side = 9.2
-	const float mrSenseRatio = (92.0f / 10.0f);
+		// 82k high side/10k low side = 9.2
+		const float mrSenseRatio = (92.0f / 10.0f);
+
+		mrSenseFunc.configure(0, 0, 1, mrSenseRatio, 0, 50);
+		mrSenseSensor.setFunction(mrSenseFunc);
+		AdcSubscription::SubscribeSensor(mrSenseSensor, EFI_ADC_16, /*bandwidth*/ 20, /*ratio*/ 1);
+		mrSenseSensor.Register();
+	}
+
+	{
+		static LinearFunc sensor5vFunc;
+		static FunctionalSensor sensor5vSensor(SensorType::Sensor5vVoltage, MS2NT(100));
+
+		const float sensor5vRatio = 2;;
+
+		sensor5vFunc.configure(0, 0, 1, sensor5vRatio, 0, 50);
+		sensor5vSensor.setFunction(sensor5vFunc);
+		AdcSubscription::SubscribeSensor(sensor5vSensor, EFI_ADC_17, /*bandwidth*/ 20, /*ratio*/ 1);
+		sensor5vSensor.Register();
+	}
 
-	mrSenseFunc.configure(0, 0, 1, mrSenseRatio, 0, 50);
-	mrSenseSensor.setFunction(mrSenseFunc);
-	AdcSubscription::SubscribeSensor(mrSenseSensor, EFI_ADC_16, /*bandwidth*/ 20, /*ratio*/ 1);
-	mrSenseSensor.Register();
 }