Add mCenterOfMass initialization at constrcutor of BodyNode class.