public void compute() { ScrewTools.getJointVelocitiesMatrix(jointsInOrder, v); centroidalMomentumRateTermCalculator.compute(); adotV.set(centroidalMomentumRateTermCalculator.getADotVTerm()); }