digital input stop

firmware/hw_layer/digital_input_hw.cpp

@@ -189,12 +189,35 @@ digital_input_s * initWaveAnalyzerDriver(const char *msg, brain_pin_e brainPin)
 	digital_input_s *hw = registeredIcus.add();
 	hw->widthListeners.clear();
 	hw->periodListeners.clear();
+	hw->started = false;
 	hw->brainPin = brainPin;
 	hw->driver = driver;
 	turnOnCapturePin(msg, brainPin);
 	return hw;
 }
 
+void stopWaveAnalyzerDriver(const char *msg, brain_pin_e brainPin) {
+	if (brainPin == GPIO_UNASSIGNED) {
+		return;
+	}
+	unmarkPin(brainPin);
+
+	ICUDriver *driver = getInputCaptureDriver(msg, brainPin);
+	if (driver == NULL) {
+		return;
+	}
+	int regSize = registeredIcus.size;
+	for (int i = 0; i < regSize; i++) {
+		if (registeredIcus.elements[i].driver == driver) {
+			// removing from driver from the list of used drivers
+			memcpy(&registeredIcus.elements[i], &registeredIcus.elements[regSize - 1],
+				sizeof(digital_input_s));
+			registeredIcus.size--;
+			return;
+		}
+	}
+}
+
 void startInputDriver(digital_input_s *hw, bool isActiveHigh) {
 	hw->isActiveHigh = isActiveHigh;
 	if (hw->isActiveHigh) {

firmware/hw_layer/digital_input_hw.h

@@ -28,6 +28,7 @@ digital_input_s *initWaveAnalyzerDriver(const char *msg, brain_pin_e brainPin);
 void startInputDriver(digital_input_s *hw, bool isActiveHigh);
 ICUDriver * getInputCaptureDriver(const char *msg, brain_pin_e hwPin);
 icuchannel_t getInputCaptureChannel(brain_pin_e hwPin);
+void stopWaveAnalyzerDriver(const char *msg, brain_pin_e brainPin);
 
 #endif
 

firmware/hw_layer/vehicle_speed.cpp

@@ -67,8 +67,7 @@ bool hasVehicleSpeedSensor() {
 }
 
 void stopVSSPins(void) {
-	unmarkPin(activeConfiguration.bc.vehicleSpeedSensorInputPin);
-	// todo: remove driver from registeredIcus
+	stopWaveAnalyzerDriver("VSS", activeConfiguration.bc.vehicleSpeedSensorInputPin);
 }
 
 void startVSSPins(void) {