Update hexapod.py

master
Zhengyu Peng 3 years ago
parent f63e4a9c60
commit 75bc391f47

@ -194,6 +194,11 @@ class Hexapod(Thread):
np.sin(j3_rad) np.sin(j3_rad)
return standby_coordinate return standby_coordinate
def calculate_sit_coordinate(self, standby_coordinate):
sit_coordinate = np.zeros_like(standby_coordinate)
sit_coordinate[:, 0:2] = standby_coordinate[:, 0:2]
return sit_coordinate
def move(self, path): def move(self, path):
for p_idx in range(0, np.shape(path)[0]): for p_idx in range(0, np.shape(path)[0]):
dest = path[p_idx, :, :] dest = path[p_idx, :, :]

Loading…
Cancel
Save