Commit 2c29b6a6 authored by Pierre Fernbach's avatar Pierre Fernbach
Browse files

add method displayFeetTrajectory in path_to_trajectory

parent 7fa87cf8
......@@ -86,6 +86,11 @@ def play_trajectory(fullBody, path_player, configs, dt_framerate=__24fps):
if elapsed < dt_framerate :
time.sleep(dt_framerate-elapsed)
def displayFeetTrajectory(path_player,end_effector_names,colors,path_ids):
assert len(end_effector_names)==len(colors)
for path_id in path_ids:
for i in range(len(end_effector_names)):
path_player.displayPath(int(path_id),colors[i],end_effector_names[i])
#~ import numpy as np
#~ com_waypoints = [np.array([i,i,i]) for i in range(6)]
......
Supports Markdown
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment