We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent c7c5ee6 commit 2bceaaeCopy full SHA for 2bceaae
1 file changed
xarm/x3/servo.py
@@ -352,11 +352,11 @@ def _get_servo_version(id_num):
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)
355
- if len(ret1) > 1:
+ if len(ret1) > 1 and abs(ret1[1]) < 1000:
356
ret1[1] = ret1[1] >> 16
357
- if len(ret2) > 1:
+ if len(ret2) > 1 and abs(ret2[1]) < 1000:
358
ret2[1] = ret2[1] >> 16
359
- if len(ret3) > 1:
+ if len(ret3) > 1 and abs(ret3[1]) < 1000:
360
ret3[1] = ret3[1] >> 16
361
else:
362
ret2 = self.get_servo_addr_16(id_num, 0x0802)
0 commit comments