Skip to content
Snippets Groups Projects
Commit 145d2071 authored by Nicolas Mansard's avatar Nicolas Mansard Committed by nmansard
Browse files

Working version, with posture, no head no arm and foot.

parent bd7e71bc
No related branches found
No related tags found
No related merge requests found
...@@ -452,7 +452,7 @@ tasklh.opmodif = matrixToTuple(mrh) ...@@ -452,7 +452,7 @@ tasklh.opmodif = matrixToTuple(mrh)
#taskHead.gain.setConstant(500) #taskHead.gain.setConstant(500)
taskHead.feature.selec.value = '111000' taskHead.feature.selec.value = '111000'
taskrf.feature.selec.value = '111111' taskrf.feature.selec.value = '111'
mrf=eye(4) mrf=eye(4)
mrf[0:3,3] = (0,0,-0.05) mrf[0:3,3] = (0,0,-0.05)
taskrf.opmodif = matrixToTuple(mrf) taskrf.opmodif = matrixToTuple(mrf)
...@@ -476,7 +476,7 @@ gCom.setConstant(100) ...@@ -476,7 +476,7 @@ gCom.setConstant(100)
mp.forward() mp.forward()
inc() inc()
go() #go()
sigset = ( lambda s,v : s.__class__.value.__set__(s,v) ) sigset = ( lambda s,v : s.__class__.value.__set__(s,v) )
#attime(200, lambda: mp.forward()) #attime(200, lambda: mp.forward())
...@@ -486,10 +486,9 @@ sigset = ( lambda s,v : s.__class__.value.__set__(s,v) ) ...@@ -486,10 +486,9 @@ sigset = ( lambda s,v : s.__class__.value.__set__(s,v) )
#attime(40*mp.timeScale, lambda: contactRF.feature.keep() ) #attime(40*mp.timeScale, lambda: contactRF.feature.keep() )
attime(40*mp.timeScale, lambda: sot.rmContact("RF"),"Remove RF contact" ) attime(40*mp.timeScale, lambda: sot.rmContact("RF"),"Remove RF contact" )
attime(40*mp.timeScale, lambda: sot.push(taskrf.task.name), "Start to track RF mocap" ) attime(40*mp.timeScale, lambda: sot.push(taskrf.task.name), "Start to track RF mocap" )
rfFinal = eye(4); rfFinal[0:3,3] = (0.02,-0.12,0.105-0.05) rfFinal = eye(4); rfFinal[0:3,3] = (0.02,-0.12,0.055)
attime(1050*mp.timeScale, attime(1050*mp.timeScale,
(lambda: sigset(taskrf.featureDes.position,matrixToTuple(rfFinal)), "RF to final position"), ((lambda: sigset(taskrf.featureDes.position,matrixToTuple(rfFinal)), "RF to final position"),
(mp.rmJointMap("Rfoot"),"Stop tracking RF mocap")) (lambda: mp.rmJointMap("Rfoot"),"Stop tracking RF mocap")) )
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