Skip to content

Commit d9f3853

Browse files
committed
fix get_angles_coords bug
1 parent 54c56ff commit d9f3853

File tree

1 file changed

+12
-1
lines changed

1 file changed

+12
-1
lines changed

pymycobot/common.py

Lines changed: 12 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -464,7 +464,18 @@ def _process_received(self, data, genre, arm=6):
464464
elif data_len == 28:
465465
for i in range(0, data_len, 4):
466466
byte_value = int.from_bytes(valid_data[i:i+4], byteorder='big', signed=True)
467-
res.append(byte_value)
467+
res.append(byte_value)
468+
elif data_len == 40:
469+
i = 0
470+
while i < data_len:
471+
if i < 28:
472+
byte_value = int.from_bytes(valid_data[i:i+4], byteorder='big', signed=True)
473+
res.append(byte_value)
474+
i+=4
475+
else:
476+
one = valid_data[i : i + 2]
477+
res.append(self._decode_int16(one))
478+
i+=2
468479
elif data_len == 30:
469480
i = 0
470481
res = []

0 commit comments

Comments
 (0)