Implemented COMM_SERVO_MOVE_WITHIN_TIME and COMM_SERVO_RESET_POS