Use the name for all the algo related to centerOfMass computations. All
of them now return the center of mass position of the whole rigid body
system. Add also to compute only the position and velocity of the CoM