Skip to content
Snippets Groups Projects
Verified Commit 8ae6dfc0 authored by Justin Carpentier's avatar Justin Carpentier Committed by Justin Carpentier
Browse files

[Joint/JointComposite] Fix type of temporary variable

parent 0f7d552c
No related branches found
No related tags found
No related merge requests found
......@@ -135,6 +135,7 @@ namespace se3
typedef JointModelTpl<Scalar,Options,JointCollectionTpl> JointModelVariant;
typedef SE3Tpl<Scalar,Options> SE3;
typedef MotionTpl<Scalar,Options> Motion;
typedef container::aligned_vector<JointModelVariant> JointModelVector;
......
......@@ -111,7 +111,7 @@ namespace se3
jmodel.calc(jdata.derived(), q.derived(), v.derived());
data.pjMi[i] = model.jointPlacements[i] * jdata.M ();
data.pjMi[i] = model.jointPlacements[i] * jdata.M();
if (succ == model.joints.size())
{
......@@ -127,7 +127,7 @@ namespace se3
data.iMlast[i] = data.pjMi[i] * data.iMlast[succ];
data.S.matrix().middleCols(idx_v,model.m_nvs[i]) = data.iMlast[succ].inverse().act(jdata.S()); // TODO: avoid computing inverse
Motion v_tmp = data.iMlast[succ].actInv(jdata.v());
typename JointModelComposite::Motion v_tmp = data.iMlast[succ].actInv(jdata.v());
data.v += v_tmp;
......
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