CoM now is given references in world coordinate frames, computed in local frame solidal to the ground