diff --git a/src/mqtt_report/src/mqtt_report.cpp b/src/mqtt_report/src/mqtt_report.cpp index 9823aad..92ec4ab 100644 --- a/src/mqtt_report/src/mqtt_report.cpp +++ b/src/mqtt_report/src/mqtt_report.cpp @@ -131,7 +131,10 @@ void Msg_Handler(const mc::msg::CanFrame::SharedPtr msg) if (bit_flag) { vehicle_error_code.addErrorCode(1401 + i); - break; // 每个 byte 最多匹配一个错误码 + } + else + { + vehicle_error_code.removeErrorCode(1401 + i); } } @@ -142,7 +145,10 @@ void Msg_Handler(const mc::msg::CanFrame::SharedPtr msg) if (bit_flag) { vehicle_error_code.addErrorCode(1409 + i); - break; // 每个 byte 最多匹配一个错误码 + } + else + { + vehicle_error_code.removeErrorCode(1409 + i); } } break; @@ -158,7 +164,10 @@ void Msg_Handler(const mc::msg::CanFrame::SharedPtr msg) if (bit_flag) { vehicle_error_code.addErrorCode(1301 + i); - break; // 每个 byte 最多匹配一个错误码 + } + else + { + vehicle_error_code.removeErrorCode(1301 + i); } } @@ -169,7 +178,10 @@ void Msg_Handler(const mc::msg::CanFrame::SharedPtr msg) if (bit_flag) { vehicle_error_code.addErrorCode(1309 + i); - break; // 每个 byte 最多匹配一个错误码 + } + else + { + vehicle_error_code.removeErrorCode(1309 + i); } } break;