We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent d7861fa commit 9ec5b29Copy full SHA for 9ec5b29
1 file changed
xarm/x3/servo.py
@@ -348,7 +348,7 @@ def _get_servo_version(id_num):
348
versions = ['*', '*', '*']
349
ret1 = self.get_servo_addr_16(id_num, 0x0801)
350
ret = self.get_servo_debug_msg()
351
- if ret[1][id_num-1]['code'] != 0:
+ if ret[1][id_num-1]['code'] != 0 or ret[1][id_num-1]['status'] == 3:
352
ret1 = self.arm_cmd.servo_error_addr_r32(id_num, 0x0801)
353
ret2 = self.arm_cmd.servo_error_addr_r32(id_num, 0x0802)
354
ret3 = self.arm_cmd.servo_error_addr_r32(id_num, 0x0803)
0 commit comments