Skip to content
Snippets Groups Projects
Commit 4bc4e3fb authored by jcarpent's avatar jcarpent
Browse files

[Test] Use new API of Jacobian functions

parent ea2db1d8
No related branches found
No related tags found
No related merge requests found
......@@ -69,7 +69,7 @@ BOOST_AUTO_TEST_CASE ( test_jacobian )
motionSet::se3Action( data.oMi[idx].inverse(), Jrh,XJrh );
BOOST_CHECK(XJrh.isApprox(rhJrh,1e-12));
jacobian(model,data,q,idx,XJrh);
jointJacobian(model,data,q,idx,XJrh);
BOOST_CHECK(XJrh.isApprox(rhJrh,1e-12));
/* Test computeJointJacobians with pre-computation of the forward kinematics */
......@@ -232,7 +232,7 @@ BOOST_AUTO_TEST_CASE ( test_timings )
timer.tic();
SMOOTH(NBT)
{
jacobian(model,data,q,idx,Jrh);
jointJacobian(model,data,q,idx,Jrh);
}
if(verbose) std::cout << "Single jacobian =\t";
timer.toc(std::cout,NBT);
......
......@@ -160,11 +160,11 @@ BOOST_AUTO_TEST_CASE (test_rnea_with_fext)
rnea(model,data_rnea,q,v,a);
VectorXd tau_ref(data_rnea.tau);
Data::Matrix6x Jrf(Data::Matrix6x::Zero(6,model.nv));
jacobian(model,data_rnea,q,rf,Jrf);
jointJacobian(model,data_rnea,q,rf,Jrf);
tau_ref -= Jrf.transpose() * Frf.toVector();
Data::Matrix6x Jlf(Data::Matrix6x::Zero(6,model.nv));
jacobian(model,data_rnea,q,lf,Jlf);
jointJacobian(model,data_rnea,q,lf,Jlf);
tau_ref -= Jlf.transpose() * Flf.toVector();
rnea(model,data_rnea_fext,q,v,a,fext);
......
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