diff --git a/software/raspberry pi/hexapod.py b/software/raspberry pi/hexapod.py index 9dde418..b2f5bb7 100644 --- a/software/raspberry pi/hexapod.py +++ b/software/raspberry pi/hexapod.py @@ -246,7 +246,7 @@ class Hexapod(Thread): angles = self.inverse_kinematics(dest) self.leg_0.move_junctions(angles[0, :]) - self.leg_5.move_junctions(angles[5, :]) + self.leg_1.move_junctions(angles[1, :]) self.leg_4.move_junctions(angles[4, :]) @@ -254,6 +254,8 @@ class Hexapod(Thread): self.leg_2.move_junctions(angles[2, :]) self.leg_3.move_junctions(angles[3, :]) + self.leg_5.move_junctions(angles[5, :]) + try: cmd_string = self.cmd_queue.get(block=False) print('interrput')