Native SENT TPS input #5079

a bit of progress
rusefi · Mar 1, 2023 · 28c3af6 · 28c3af6
1 parent 3f537a6
commit 28c3af6
Show file tree

Hide file tree

Showing 4 changed files with 15 additions and 4 deletions.
diff --git a/firmware/controllers/sensors/tps.cpp b/firmware/controllers/sensors/tps.cpp
@@ -45,3 +45,6 @@ bool isTps2Error() {
 bool isPedalError() {
     return !Sensor::get(SensorType::AcceleratorPedal).Valid && Sensor::hasSensor(SensorType::AcceleratorPedalPrimary);
 }
+
+void sentTpsDecode() {
+}
diff --git a/firmware/controllers/sensors/tps.h b/firmware/controllers/sensors/tps.h
@@ -29,6 +29,8 @@ void grabTPSIsWideOpen();
 void grabPedalIsUp();
 void grabPedalIsWideOpen();
 
+void sentTpsDecode();
+
 bool isTps1Error();
 bool isTps2Error();
 bool isPedalError();
diff --git a/firmware/hw_layer/drivers/sent/sent.cpp b/firmware/hw_layer/drivers/sent/sent.cpp
@@ -580,6 +580,7 @@ static void SentDecoderThread(void*) {
 
 
 					/* Call high level decoder from here */
+					sentTpsDecode();
 				}
 			}
 		}

diff --git a/firmware/init/sensor/init_tps.cpp b/firmware/init/sensor/init_tps.cpp
@@ -203,10 +203,15 @@ void initTps() {
 			tpsSecondaryMaximum = 20;
 		}
 
-		analogTps1.init(isFordTps, &fordTps1, tpsSecondaryMaximum,
-			{ engineConfiguration->tps1_1AdcChannel, (float)engineConfiguration->tpsMin, (float)engineConfiguration->tpsMax, min, max },
-			{ engineConfiguration->tps1_2AdcChannel, (float)engineConfiguration->tps1SecondaryMin, (float)engineConfiguration->tps1SecondaryMax, min, max }
-		);
+
+        if (isDigitalTps1()) {
+            sentTps.Register();
+        } else {
+		    analogTps1.init(isFordTps, &fordTps1, tpsSecondaryMaximum,
+    			{ engineConfiguration->tps1_1AdcChannel, (float)engineConfiguration->tpsMin, (float)engineConfiguration->tpsMax, min, max },
+	    		{ engineConfiguration->tps1_2AdcChannel, (float)engineConfiguration->tps1SecondaryMin, (float)engineConfiguration->tps1SecondaryMax, min, max }
+		    );
+		}
 
 		tps2.init(isFordTps, &fordTps2, tpsSecondaryMaximum,
 			{ engineConfiguration->tps2_1AdcChannel, (float)engineConfiguration->tps2Min, (float)engineConfiguration->tps2Max, min, max },