Update hexapod.py

3 years ago · 9874e5d75a
parent dc63c12836
commit 9874e5d75a
1 changed files with 2 additions and 4 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,8 +254,6 @@ 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')