Add a test to bodyJacobian.
Optimize bodyJacobian.
Add a bench to Jacobian::vectorBodyJacobian.
Optimize vectorBodyJacobian.
Add a bench to Jacobian::jacobianDot and Jacobian::bodyJacobianDot.
Some style change for jacobianDot and bodyJacobianDot (no optimization).