Update hexapod.py

master
Zhengyu Peng 3 years ago
parent d6e649253f
commit ef006ee29e

@ -246,7 +246,7 @@ class Hexapod(Thread):
angles = self.inverse_kinematics(dest) angles = self.inverse_kinematics(dest)
self.leg_0.move_junctions(angles[0, :]) self.leg_0.move_junctions(angles[0, :])
self.leg_5.move_junctions(angles[5, :])
self.leg_1.move_junctions(angles[1, :]) self.leg_1.move_junctions(angles[1, :])
self.leg_4.move_junctions(angles[4, :]) self.leg_4.move_junctions(angles[4, :])
@ -254,6 +254,8 @@ class Hexapod(Thread):
self.leg_2.move_junctions(angles[2, :]) self.leg_2.move_junctions(angles[2, :])
self.leg_3.move_junctions(angles[3, :]) self.leg_3.move_junctions(angles[3, :])
self.leg_5.move_junctions(angles[5, :])
try: try:
cmd_string = self.cmd_queue.get(block=False) cmd_string = self.cmd_queue.get(block=False)
print('interrput') print('interrput')

Loading…
Cancel
Save