From df98eb69d4e14d28c2fbc750d61b7360123ef277 Mon Sep 17 00:00:00 2001
From: Andrey <rusefillc@gmail.com>
Date: Thu, 11 Nov 2021 20:27:45 -0500
Subject: [PATCH] Bench Test IAC Valve fails #3534

---
 firmware/controllers/algo/engine_types.h | 18 +++++++++++++++---
 firmware/controllers/bench_test.cpp      | 17 ++++++++---------
 2 files changed, 23 insertions(+), 12 deletions(-)

diff --git a/firmware/controllers/algo/engine_types.h b/firmware/controllers/algo/engine_types.h
index d9739ee5bf..581810b840 100644
--- a/firmware/controllers/algo/engine_types.h
+++ b/firmware/controllers/algo/engine_types.h
@@ -559,18 +559,30 @@ typedef enum {
 	TS_IGNITION_CATEGORY = 18,
 	TS_INJECTOR_CATEGORY = 19,
 	TS_X14 = 20,
+	TS_WIDEBAND = 21,
+	TS_BENCH_CATEGORY = 22,
+	TS_UNUSED_23 = 23,
+	TS_UNUSED_CJ125_CALIB = 24,
+	TS_UNUSED_25 = 23,
+	TS_UNUSED_26 = 23,
+	TS_UNUSED_27 = 23,
+	TS_UNUSED_28 = 23,
+	TS_UNUSED_29 = 23,
+	TS_UNUSED_30 = 30,
+	TS_UNUSED_31 = 30,
+	TS_CRAZY = 32,
 } ts_command_e;
 
 typedef enum {
-	BENCH_MAIN_RELAY,
+	BENCH_MAIN_RELAY, // 0
 	BENCH_FUEL_PUMP,
 	BENCH_STARTER_ENABLE_RELAY,
 	BENCH_STARTER_DISABLE_RELAY,
 	BENCH_FAN_RELAY,
-	BENCH_FAN_RELAY_2,
+	BENCH_FAN_RELAY_2, // 5
 	BENCH_AC_COMPRESSOR_RELAY,
 	BENCH_CHECK_ENGINE_LIGHT,
-	BENCH_IDLE_VALVE,
+	BENCH_IDLE_VALVE, // 8
 	BENCH_HPFP_VALVE,
 	BENCH_GPPWM1_VALVE,
 	BENCH_GPPWM2_VALVE,
diff --git a/firmware/controllers/bench_test.cpp b/firmware/controllers/bench_test.cpp
index d43ed5f954..cd908f0177 100644
--- a/firmware/controllers/bench_test.cpp
+++ b/firmware/controllers/bench_test.cpp
@@ -313,6 +313,12 @@ static void handleBenchCategory(uint16_t index) {
 	case BENCH_FAN_RELAY:
 		fanBench();
 		return;
+	case BENCH_IDLE_VALVE:
+		// cmd_test_idle_valve
+#if EFI_IDLE_CONTROL
+		startIdleBench();
+#endif /* EFI_IDLE_CONTROL */
+		return;
 	case BENCH_FAN_RELAY_2:
 		fan2Bench();
 		return;
@@ -464,20 +470,13 @@ void executeTSCommand(uint16_t subsystem, uint16_t index) {
 		handleBenchCategory(index);
 		break;
 
-	case CMD_TS_X17:
-		// cmd_test_idle_valve
-#if EFI_IDLE_CONTROL
-		startIdleBench();
-#endif /* EFI_IDLE_CONTROL */
-		break;
-
-	case 0x18:
+	case TS_UNUSED_CJ125_CALIB:
 #if EFI_CJ125 && HAL_USE_SPI
 		cjStartCalibration();
 #endif /* EFI_CJ125 */
 		break;
 
-	case 0x20:
+	case TS_CRAZY:
 		if (index == 0x3456) {
 			// call to pit
 			setCallFromPitStop(30000);