deduplicate sensor init

firmware/init/init.h

@@ -42,6 +42,7 @@ void deinitThermistors();
 void deinitFluidPressure();
 void deinitLambda();
 void deInitFlexSensor();
+void deinitAuxSensors();
 void deInitVehicleSpeedSensor();
 void deinitTurbochargerSpeedSensor();
 void deinitMap();

firmware/init/sensor/init_aux.cpp

@@ -48,3 +48,10 @@ void initAuxSensors() {
 		sensor.Register();
 	}
 }
+
+void deinitAuxSensors() {
+	for (size_t i = 0; i < efi::size(engineConfiguration->auxAnalogInputs); i++) {
+		AdcSubscription::UnsubscribeSensor(auxSensors[i]);
+		auxSensors[i].unregister();
+	}
+}

firmware/init/sensor/init_sensors.cpp

@@ -63,26 +63,16 @@ static void deInitAuxDigital() {
 }
 
 void initNewSensors() {
-	initVbatt();
+	reconfigureSensors();
-	initMap();
+
-	initTps();
-	initFluidPressure();
-	initThermistors();
-	initLambda();
-	initFlexSensor();
 	initBaro();
-	initAuxSensors();
-	initVehicleSpeedSensor();
-	initTurbochargerSpeedSensor();
 	initAuxSpeedSensors();
-	initInputShaftSpeedSensor();
 
 	#if !EFI_UNIT_TEST
 		initFuelLevel();
 		initMaf();
 	#endif
 
-	initOldAnalogInputs();
 	initAuxDigital();
 
 	// Init CLI functionality for sensors (mocking)
@@ -113,6 +103,7 @@ void stopSensors() {
 	deinitThermistors();
 	deinitLambda();
 	deInitFlexSensor();
+	deinitAuxSensors();
 	deInitVehicleSpeedSensor();
 	deinitTurbochargerSpeedSensor();
 	deinitAuxSpeedSensors();
@@ -121,13 +112,14 @@ void stopSensors() {
 }
 
 void reconfigureSensors() {
+	initVbatt();
 	initMap();
 	initTps();
 	initFluidPressure();
-	initVbatt();
 	initThermistors();
 	initLambda();
 	initFlexSensor();
+	initAuxSensors();
 	initVehicleSpeedSensor();
 	initTurbochargerSpeedSensor();
 	initInputShaftSpeedSensor();