Fix bug: BodyNode::getWorldCOM() returned wrong center of mass
Merge branch 'release-3.0' of github.com:dartsim/dart into release-3.0