Skip to content
Snippets Groups Projects
Commit fec07007 authored by Pierre Fernbach's avatar Pierre Fernbach
Browse files

[script] add kinematic constraints path in talos script

parent 86fe01d2
No related branches found
No related tags found
No related merge requests found
...@@ -31,10 +31,10 @@ print "Generate limb DB ..." ...@@ -31,10 +31,10 @@ print "Generate limb DB ..."
tStart = time.time() tStart = time.time()
# generate databases : # generate databases :
nbSamples = 10000 nbSamples = 50000
fullBody.addLimb(fullBody.rLegId,fullBody.rleg,fullBody.rfoot,fullBody.rLegOffset,fullBody.rLegNormal, fullBody.rLegx, fullBody.rLegy, nbSamples, "fixedStep06", 0.01) fullBody.addLimb(fullBody.rLegId,fullBody.rleg,fullBody.rfoot,fullBody.rLegOffset,fullBody.rLegNormal, fullBody.rLegx, fullBody.rLegy, nbSamples, "fixedStep1", 0.01,kinematicConstraintsPath=fullBody.rLegKinematicConstraints)
fullBody.runLimbSampleAnalysis(fullBody.rLegId, "ReferenceConfiguration", True) fullBody.runLimbSampleAnalysis(fullBody.rLegId, "ReferenceConfiguration", True)
fullBody.addLimb(fullBody.lLegId,fullBody.lleg,fullBody.lfoot,fullBody.lLegOffset,fullBody.rLegNormal, fullBody.lLegx, fullBody.lLegy, nbSamples, "fixedStep06", 0.01) fullBody.addLimb(fullBody.lLegId,fullBody.lleg,fullBody.lfoot,fullBody.lLegOffset,fullBody.rLegNormal, fullBody.lLegx, fullBody.lLegy, nbSamples, "fixedStep1", 0.01,kinematicConstraintsPath=fullBody.lLegKinematicConstraints)
fullBody.runLimbSampleAnalysis(fullBody.lLegId, "ReferenceConfiguration", True) fullBody.runLimbSampleAnalysis(fullBody.lLegId, "ReferenceConfiguration", True)
...@@ -81,7 +81,7 @@ fullBody.setEndState(q_goal,[fullBody.rLegId,fullBody.lLegId]) ...@@ -81,7 +81,7 @@ fullBody.setEndState(q_goal,[fullBody.rLegId,fullBody.lLegId])
print "Generate contact plan ..." print "Generate contact plan ..."
tStart = time.time() tStart = time.time()
configs = fullBody.interpolate(0.01,pathId=pId,robustnessTreshold = 2, filterStates = True,testReachability=False) configs = fullBody.interpolate(0.01,pathId=pId,robustnessTreshold = 2, filterStates = True)
tInterpolateConfigs = time.time() - tStart tInterpolateConfigs = time.time() - tStart
print "Done." print "Done."
print "number of configs :", len(configs) print "number of configs :", len(configs)
......
...@@ -87,7 +87,7 @@ pp = PathPlayer (v) ...@@ -87,7 +87,7 @@ pp = PathPlayer (v)
pp.dt=0.03 pp.dt=0.03
pp.displayVelocityPath(0) pp.displayVelocityPath(0)
v.client.gui.setVisibility("path_0_root","ALWAYS_ON_TOP") v.client.gui.setVisibility("path_0_root","ALWAYS_ON_TOP")
pp(0) #pp(0)
# move the robot out of the view before computing the contacts # move the robot out of the view before computing the contacts
q_far = q_init[::] q_far = q_init[::]
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment