From 3e86c5bb0cdaa03847a6690ecf0cc1d3c903d957 Mon Sep 17 00:00:00 2001
From: Andrey <rusefillc@gmail.com>
Date: Tue, 3 Jan 2023 21:16:05 -0500
Subject: [PATCH] getDigital only works for 4 specific pins. Can it be made to
 work with generic digital pins? #4861

---
 firmware/init/sensor/init_sensors.cpp | 14 ++++++++++++++
 1 file changed, 14 insertions(+)

diff --git a/firmware/init/sensor/init_sensors.cpp b/firmware/init/sensor/init_sensors.cpp
index 57e11d12d3..c8b4ba5aa1 100644
--- a/firmware/init/sensor/init_sensors.cpp
+++ b/firmware/init/sensor/init_sensors.cpp
@@ -45,6 +45,18 @@ static void deInitOldAnalogInputs() {
 	deInitIfValid("CJ125 UA", activeConfiguration.cj125ua);
 }
 
+static void initAuxDigital() {
+	for (size_t i = 0;i<efi::size(engineConfiguration->luaDigitalInputPins);i++) {
+		efiSetPadMode("Lua Digital", engineConfiguration->luaDigitalInputPins[i], getInputMode(PI_DEFAULT));
+	}
+}
+
+static void deInitAuxDigital() {
+	for (size_t i = 0;i<efi::size(activeConfiguration.luaDigitalInputPins);i++) {
+		brain_pin_markUnused(activeConfiguration.luaDigitalInputPins[i]);
+	}
+}
+
 void initNewSensors() {
 #if EFI_PROD_CODE && EFI_CAN_SUPPORT
 	initCanSensors();
@@ -70,6 +82,7 @@ void initNewSensors() {
 	#endif
 
 	initOldAnalogInputs();
+	initAuxDigital();
 
 	// Init CLI functionality for sensors (mocking)
 	initSensorCli();
@@ -85,6 +98,7 @@ void initNewSensors() {
 }
 
 void stopSensors() {
+	deInitAuxDigital();
 	deInitOldAnalogInputs();
 
 	deinitTps();