diff --git a/script/dynamic/plateform_hrp2_interp_testTransition.py b/script/dynamic/plateform_hrp2_interp_testTransition.py index 684105962385b311363ddaa474951b99b7a99717..9885a9fc193e20dcca4fb130e8eef5386e8a9e9e 100644 --- a/script/dynamic/plateform_hrp2_interp_testTransition.py +++ b/script/dynamic/plateform_hrp2_interp_testTransition.py @@ -170,8 +170,21 @@ sf2 = State(fullBody,q=q_goal,limbsIncontact=[lLegId,rLegId]) pid = fullBody.isDynamicallyReachableFromState(smid.sId,smid2.sId,True) import disp_bezier +pp.dt = 0.00001 disp_bezier.showPath(r,pp,pid) +x = [0.776624, 0.219798, 0.846351] + + +moveSphere('s',r,x) +displayBezierConstraints(r) + +path = "/local/dev_hpp/screenBlender/iros2018/polytopes/platform/path" +for i in range(1,4): + r.client.gui.writeNodeFile('path_'+str(int(pid[i]))+'_root',path+str(i-1)+'.obj') + +r.client.gui.writeNodeFile('s',path+'_S.stl') + """ com = fullBody.getCenterOfMass() com[1] = 0