shark/hexapod
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Update hexapod.py

Browse Source
This commit is contained in:
Zhengyu Peng 2022-01-17 22:22:22 -05:00
parent e8c53a6fed
commit 34f1a2c15b
1 changed files with 5 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
software/raspberry pi/hexapod.py
View File

@ -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, :, :]