Skip to content
Snippets Groups Projects
Commit 4ef47a93 authored by Nicolas Mansard's avatar Nicolas Mansard Committed by Valenza Florian
Browse files

Minor bug correction (was not compiling).

parent fb90af5f
Branches
Tags
No related merge requests found
......@@ -45,9 +45,6 @@ namespace se3
if(parent>0) data.oMi[i] = data.oMi[parent]*data.liMi[i];
else data.oMi[i] = data.liMi[i];
// std::cout << data.oMi[i] << std::endl << std::endl;
// std::cout << data.oMi[i].toActionMatrix() << std::endl << std::endl;
// std::cout << data.oMi[i].act(jdata.S()) << std::endl << std::endl;
data.J.block(0,jmodel.idx_v(),6,jmodel.nv()) = data.oMi[i].act(jdata.S());
}
......@@ -81,8 +78,6 @@ namespace se3
if(! localFrame ) J.col(j) = data.J.col(j);
else J.col(j) = oMjoint.actInv(Motion(data.J.col(j))).toVector();
}
if(localFrame)
}
} // namespace se3
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment