CAN side of automated testing #4630

firmware/config/boards/microrusefi/board_configuration.cpp

@@ -224,3 +224,7 @@ void setBoardDefaultConfiguration() {
 int getBoardMetaOutputsCount() {
     return efi::size(MRE_OUTPUTS);
 }
+
+Gpio* getBoardMetaOutputs() {
+    return &MRE_OUTPUTS;
+}

firmware/config/boards/proteus/board_configuration.cpp

@@ -201,3 +201,7 @@ void boardPrepareForStop() {
 int getBoardMetaOutputsCount() {
     return efi::size(PROTEUS_OUTPUTS);
 }
+
+Gpio* getBoardMetaOutputs() {
+    return &PROTEUS_OUTPUTS;
+}

firmware/controllers/algo/engine_configuration.cpp

@@ -1152,3 +1152,4 @@ __attribute__((weak)) void setBoardDefaultConfiguration() { }
 __attribute__((weak)) void setBoardConfigOverrides() { }
 
 __attribute__((weak)) int getBoardMetaOutputsCount() { return 0; }
+__attribute__((weak)) Gpio* getBoardMetaOutputs() { return nullptr; }

firmware/controllers/algo/engine_configuration.h

@@ -99,3 +99,4 @@ extern bool isActiveConfigurationVoid;
 #define isPinOrModeChanged(pin, mode) (isConfigurationChanged(pin) || isConfigurationChanged(mode))
 
 int getBoardMetaOutputsCount();
+Gpio* getBoardMetaOutputs();

firmware/controllers/can/can_bench_test.cpp

@@ -10,6 +10,14 @@
 
 #if EFI_CAN_SUPPORT
 
+static void setPin(const CANRxFrame& frame, int value) {
+		int index = frame.data8[1];
+		if (index >= getBoardMetaOutputsCount())
+			return;
+		Gpio pin = getBoardMetaOutputs()[index];
+		palWritePad(getHwPort("can_write", pin), getHwPin("can_write", pin), value);
+}
+
 void processCanBenchTest(const CANRxFrame& frame) {
 	if (CAN_EID(frame) != CAN_ECU_HW_META) {
 		return;
@@ -24,12 +32,11 @@ void processCanBenchTest(const CANRxFrame& frame) {
 		msg[1] = 0;
 		msg[2] = getBoardMetaOutputsCount();
 
-	} else if (command == CAN_BENCH_GET_COUNT) {
-
+	} else if (command == CAN_BENCH_GET_SET) {
+	    setPin(frame, 1);
+	} else if (command == CAN_BENCH_GET_CLEAR) {
+	    setPin(frame, 0);
 	}
-
-
 }
 
-
 #endif // EFI_CAN_SUPPORT