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); /*******************************************************************************