Update hexapod.py

3 years ago · ef006ee29e
parent d6e649253f
commit ef006ee29e
1 changed files with 3 additions and 1 deletions
--- a/software/raspberry
+++ b/software/raspberry
@ -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')