Commit 466ee04c authored by Pierre Fernbach's avatar Pierre Fernbach
Browse files

[contact sequence] add an option to ignore rotation of feet (for debug)

parent cd454cff
......@@ -98,6 +98,7 @@ def generateContactSequence(fb,configs,beginId,endId,viewer=None, curves_initGue
MLF = SE3.Identity()
MRF.translation = np.matrix(q_rl[0:3])
MLF.translation = np.matrix(q_ll[0:3])
if not FORCE_STRAIGHT_LINE :
rot_rl = Quaternion(q_rl[3],q_rl[4],q_rl[5],q_rl[6])
rot_ll = Quaternion(q_ll[3],q_ll[4],q_ll[5],q_ll[6])
MRF.rotation = rot_rl.matrix()
......@@ -319,6 +320,7 @@ def generateContactSequence(fb,configs,beginId,endId,viewer=None, curves_initGue
MLF = SE3.Identity()
MRF.translation = np.matrix(q_rl[0:3])
MLF.translation = np.matrix(q_ll[0:3])
if not FORCE_STRAIGHT_LINE :
rot_rl = Quaternion(q_rl[3],q_rl[4],q_rl[5],q_rl[6])
rot_ll = Quaternion(q_ll[3],q_ll[4],q_ll[5],q_ll[6])
MRF.rotation = rot_rl.matrix()
......
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