add(actuator):添加推杆的驱动函数已经验证OK。

This commit is contained in:
2026-07-28 15:28:30 +08:00
parent cb720da01f
commit 6e3290c70e
6 changed files with 197 additions and 35 deletions
+12 -11
View File
@@ -21,6 +21,7 @@
#include "gd32e23x_usart.h"
#include "i2c.h"
#include "core_cm23.h"
#include "actuator.h"
/* ============================================================================
* 协议格式说明
@@ -67,15 +68,15 @@
/** @name 响应帧标识符
* @{ */
#define RESP_HEADER 0xB5 /**< 响应帧包头标识 >**/
#define RESP_TYPE_OK 0xF0 /**< 成功响应类型 >**/
#define RESP_TYPE_CRC_ERR 0xF1 /**< CRC校验错误 >**/
#define RESP_TYPE_HEADER_ERR 0xF2 /**< 包头错误 >**/
#define RESP_TYPE_TYPE_ERR 0xF3 /**< 板类型错误 >**/
#define RESP_TYPE_LEN_ERR 0xF4 /**< 长度错误 >**/
#define RESP_TYPE_PARAM_ERR 0xFD /**< 参数错误 >**/
#define RESP_TYPE_CMD_ERR 0xFE /**< 命令错误 >**/
#define RESP_TYPE_ERR 0xFF /**< 通用错误 >**/
#define RESP_HEADER 0xB5 /**< 响应帧包头标识 */
#define RESP_TYPE_OK 0xF0 /**< 成功响应类型 */
#define RESP_TYPE_CRC_ERR 0xF1 /**< CRC校验错误 */
#define RESP_TYPE_HEADER_ERR 0xF2 /**< 包头错误 */
#define RESP_TYPE_TYPE_ERR 0xF3 /**< 板类型错误 */
#define RESP_TYPE_LEN_ERR 0xF4 /**< 长度错误 */
#define RESP_TYPE_PARAM_ERR 0xFD /**< 参数错误 */
#define RESP_TYPE_CMD_ERR 0xFE /**< 命令错误 */
#define RESP_TYPE_ERR 0xFF /**< 通用错误 */
/** @} */
/* ============================================================================
@@ -101,7 +102,7 @@ void system_software_reset(void)
}
/* Debug output control */
#if COM_DEBUG == ENABLE
#if COM_DEBUG == CFG_ENABLE
#include <stdio.h>
#define COMMAND_DEBUG(fmt, ...) printf("[COMMAND] " fmt "\n", ##__VA_ARGS__)
#else
@@ -565,7 +566,7 @@ void command_process(void) {
// 到帧尾,进行各项校验
bool verification_status = true;
#if DEBUG_VERBOSE == ENABLE
#if DEBUG_VERBOSE == CFG_ENABLE
if (cmd_buf[0] != PROTOCOL_PACKAGE_HEADER) {
send_response(RESP_TYPE_HEADER_ERR, s_report_status_err, sizeof(s_report_status_err));
verification_status = false;