Factorize code arm creation code in JacobianTest.cpp.
Add methods to jacobian to avoid to compute J·q and JDot·q with the full jacobian.