Use mass center in RigidRepresentation Contact and VTC

Use the mass center of rigid representations when build the mlcp problem
and calculating forces in the virtual tool coupler.