add backward move
This commit is contained in:
@ -11,7 +11,7 @@ from leg import Leg
|
||||
import numpy as np
|
||||
import time
|
||||
import json
|
||||
from path_generator import forward_path
|
||||
from path_generator import forward_path, backward_path
|
||||
|
||||
|
||||
SIN30 = 0.5
|
||||
@ -93,6 +93,11 @@ class Hexapod:
|
||||
for mm in range(0, 30):
|
||||
self.move(full_path, 0.005)
|
||||
|
||||
full_path = backward_path()
|
||||
|
||||
for mm in range(0, 30):
|
||||
self.move(full_path, 0.005)
|
||||
|
||||
def move(self, path, interval):
|
||||
for p_idx in range(0, np.shape(path)[0]):
|
||||
dest = path[p_idx, :, :]+self.standby_coordinate
|
||||
|
Reference in New Issue
Block a user