Skip to content
Snippets Groups Projects
Commit 0d11dd24 authored by jcarpent's avatar jcarpent
Browse files

[C++] Use jointId instead of idx

parent 939c994c
Branches
Tags
No related merge requests found
......@@ -180,10 +180,10 @@ namespace se3
inline const Eigen::MatrixXd&
jacobian(const Model & model, Data& data,
const Eigen::VectorXd & q,
const Model::Index & idx )
const Model::Index & jointId)
{
data.iMf[idx] = SE3::Identity();
for( Model::Index i=idx;i>0;i=model.parents[i] )
data.iMf[jointId] = SE3::Identity();
for( Model::Index i=jointId;i>0;i=model.parents[i] )
{
JacobianForwardStep::run(model.joints[i],data.joints[i],
JacobianForwardStep::ArgsType(model,data,q));
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment