From 4d3ba4850c28caff7cca2e21dbb8e5a64d0e8e10 Mon Sep 17 00:00:00 2001
From: rusefi <rusefillc@gmail.com>
Date: Tue, 8 Sep 2020 17:41:32 -0400
Subject: [PATCH] Bench-testing for ALL assigned output pins #1758

---
 firmware/controllers/bench_test.cpp | 35 +++++++++++++++++++----------
 1 file changed, 23 insertions(+), 12 deletions(-)

diff --git a/firmware/controllers/bench_test.cpp b/firmware/controllers/bench_test.cpp
index f27c3c2c7d..60abe33cc6 100644
--- a/firmware/controllers/bench_test.cpp
+++ b/firmware/controllers/bench_test.cpp
@@ -185,6 +185,10 @@ void acRelayBench(void) {
 	pinbench("0", "1000", "100", "1", &enginePins.acRelay, CONFIG(acRelayPin));
 }
 
+void mainRelayBench(void) {
+	pinbench("0", "1000", "100", "1", &enginePins.mainRelay, CONFIG(mainRelayPin));
+}
+
 void fuelPumpBench(void) {
 	fuelPumpBenchExt("3000");
 }
@@ -247,17 +251,30 @@ private:
 static BenchController instance;
 
 static void handleBenchCategory(uint16_t index) {
-	// cmd_test_check_engine_light
-	milBench();
+	switch(index) {
+	case CMD_TS_BENCH_MAIN_RELAY:
+		mainRelayBench();
+		return;
+	case CMD_TS_BENCH_FUEL_PUMP:
+		// cmd_test_fuel_pump
+		fuelPumpBench();
+		return;
+	case CMD_TS_BENCH_STARTER_ENABLE_RELAY:
+		starterRelayBench();
+		return;
+	case CMD_TS_BENCH_CHECK_ENGINE_LIGHT:
+		// cmd_test_check_engine_light
+		milBench();
+		return;
+	case CMD_TS_BENCH_AC_COMPRESSOR_RELAY:
+		acRelayBench();
+		return;
+	}
 
 }
 
 static void handleCommandX14(uint16_t index) {
 	switch (index) {
-	case 1:
-		// cmd_test_fuel_pump
-		fuelPumpBench();
-		return;
 	case 2:
 		grabTPSIsClosed();
 		return;
@@ -277,18 +294,12 @@ static void handleCommandX14(uint16_t index) {
 		requestTLE8888initialization();
 #endif
 		return;
-	case 9:
-		acRelayBench();
-		return;
 	case 0xA:
 		// cmd_write_config
 #if EFI_INTERNAL_FLASH
 		writeToFlashNow();
 #endif /* EFI_INTERNAL_FLASH */
 		return;
-	case 0xB:
-		starterRelayBench();
-		return;
 	case 0xD:
 		engine->directSelfStimulation = true;
 		return;