From a7f08c437c511fee6176ebd704ae24464d23917f Mon Sep 17 00:00:00 2001 From: zhaohe Date: Sat, 3 Feb 2024 16:08:04 +0800 Subject: [PATCH] fix protocol parser bug --- protocol_parser.cpp | 2 ++ 1 file changed, 2 insertions(+) diff --git a/protocol_parser.cpp b/protocol_parser.cpp index de490db..3fe224f 100644 --- a/protocol_parser.cpp +++ b/protocol_parser.cpp @@ -208,6 +208,7 @@ void ZIProtocolParser::onRceivePacket(zcr_cmd_header_t* rxcmd, uint8_t* data, in virtual int32_t motor_easy_move_by(int32_t distance) { return err::koperation_not_support; }; virtual int32_t motor_easy_move_to(int32_t position) { return err::koperation_not_support; }; virtual int32_t motor_easy_move_to_zero(int32_t direction) { return err::koperation_not_support; }; + virtual int32_t motor_easy_set_current_pos(int32_t pos) { return err::koperation_not_support; }; virtual int32_t motor_easy_move_to_io(int32_t ioindex, int32_t direction) { return err::koperation_not_support; }; #endif @@ -231,6 +232,7 @@ void ZIProtocolParser::onRceivePacket(zcr_cmd_header_t* rxcmd, uint8_t* data, in PROCESS_PACKET_10(kmotor_easy_move_by, ZIMotor, motor_easy_move_by); PROCESS_PACKET_10(kmotor_easy_move_to, ZIMotor, motor_easy_move_to); PROCESS_PACKET_10(kmotor_easy_move_to_zero, ZIMotor, motor_easy_move_to_zero); + PROCESS_PACKET_10(kmotor_easy_set_current_pos, ZIMotor, motor_easy_set_current_pos); PROCESS_PACKET_20(kmotor_easy_move_to_io, ZIMotor, motor_easy_move_to_io); /*******************************************************************************