|
|
@ -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')
|
|
|
|