Skip to content

Commit 2bceaae

Browse files
committed
[fix] fix get_servo_version
1 parent c7c5ee6 commit 2bceaae

1 file changed

Lines changed: 3 additions & 3 deletions

File tree

xarm/x3/servo.py

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -352,11 +352,11 @@ def _get_servo_version(id_num):
352352
ret1 = self.arm_cmd.servo_error_addr_r32(id_num, 0x0801)
353353
ret2 = self.arm_cmd.servo_error_addr_r32(id_num, 0x0802)
354354
ret3 = self.arm_cmd.servo_error_addr_r32(id_num, 0x0803)
355-
if len(ret1) > 1:
355+
if len(ret1) > 1 and abs(ret1[1]) < 1000:
356356
ret1[1] = ret1[1] >> 16
357-
if len(ret2) > 1:
357+
if len(ret2) > 1 and abs(ret2[1]) < 1000:
358358
ret2[1] = ret2[1] >> 16
359-
if len(ret3) > 1:
359+
if len(ret3) > 1 and abs(ret3[1]) < 1000:
360360
ret3[1] = ret3[1] >> 16
361361
else:
362362
ret2 = self.get_servo_addr_16(id_num, 0x0802)

0 commit comments

Comments
 (0)