hulk/ultrasonic_cmake_vscode
1
0
Fork 0
generated from hulk/gd32e23x_template_cmake_vscode
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

注释异常命令回包

Browse Source
This commit is contained in:
yelvlab
2025-09-16 14:58:33 +08:00
parent 70b8e3a602
commit 14fa262d35
1 changed files with 7 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files

14
Src/command.c
View File

@@ -226,7 +226,7 @@ void handle_command(const uint8_t *frame, uint8_t len) {
// 命令必须以 'M' 开头 // 命令必须以 'M' 开头
if (cmd[0] != 'M'){ if (cmd[0] != 'M'){
send_response(RESP_TYPE_TYPE_ERR, s_report_status_err, sizeof(s_report_status_err)); // send_response(RESP_TYPE_TYPE_ERR, s_report_status_err, sizeof(s_report_status_err));
return; return;
} }
@@ -238,7 +238,7 @@ void handle_command(const uint8_t *frame, uint8_t len) {
if (used_base_cmd == 0) if (used_base_cmd == 0)
{ {
// 'M' 后没有数字，格式错误 // 'M' 后没有数字，格式错误
send_response(RESP_TYPE_LEN_ERR, s_report_status_err, sizeof(s_report_status_err)); // send_response(RESP_TYPE_LEN_ERR, s_report_status_err, sizeof(s_report_status_err));
return; return;
} }
@@ -291,7 +291,7 @@ void handle_command(const uint8_t *frame, uint8_t len) {
break; break;
} }
// 未在处理列表的无参数基础命令，回复错误 // 未在处理列表的无参数基础命令，回复错误
send_response(RESP_TYPE_TYPE_ERR, s_report_status_err, sizeof(s_report_status_err)); // send_response(RESP_TYPE_TYPE_ERR, s_report_status_err, sizeof(s_report_status_err));
return; return;
} }
@@ -302,7 +302,7 @@ void handle_command(const uint8_t *frame, uint8_t len) {
const uint8_t used_param_cmd = parse_uint_dec(&cmd[cmd_index], (uint8_t)(cmd_len - cmd_index), &param_value); const uint8_t used_param_cmd = parse_uint_dec(&cmd[cmd_index], (uint8_t)(cmd_len - cmd_index), &param_value);
if (used_param_cmd == 0) { if (used_param_cmd == 0) {
// 'S' 后没有数字，格式错误 // 'S' 后没有数字，格式错误
send_response(RESP_TYPE_LEN_ERR, s_report_status_err, sizeof(s_report_status_err)); // send_response(RESP_TYPE_LEN_ERR, s_report_status_err, sizeof(s_report_status_err));
return; return;
} }
@@ -315,7 +315,7 @@ void handle_command(const uint8_t *frame, uint8_t len) {
default: default:
break; break;
} }
send_response(RESP_TYPE_TYPE_ERR, s_report_status_err, sizeof(s_report_status_err)); // send_response(RESP_TYPE_TYPE_ERR, s_report_status_err, sizeof(s_report_status_err));
} }
} }
@@ -395,14 +395,14 @@ void command_process(void) {
#endif #endif
if (verification_status && cmd_buf[1] != PROTOCOL_BOARD_TYPE) { if (verification_status && cmd_buf[1] != PROTOCOL_BOARD_TYPE) {
send_response(RESP_TYPE_TYPE_ERR, s_report_status_err, sizeof(s_report_status_err)); // send_response(RESP_TYPE_TYPE_ERR, s_report_status_err, sizeof(s_report_status_err));
verification_status = false; verification_status = false;
} }
if (verification_status) { if (verification_status) {
uint8_t crc_calc = command_sum_crc_calc(cmd_buf, expected_cmd_len); uint8_t crc_calc = command_sum_crc_calc(cmd_buf, expected_cmd_len);
uint8_t crc_recv = cmd_buf[expected_cmd_len - 1]; uint8_t crc_recv = cmd_buf[expected_cmd_len - 1];
if (crc_calc != crc_recv) { if (crc_calc != crc_recv) {
send_response(RESP_TYPE_CRC_ERR, s_report_status_err, sizeof(s_report_status_err)); // send_response(RESP_TYPE_CRC_ERR, s_report_status_err, sizeof(s_report_status_err));
verification_status = false; verification_status = false;
} }
} }