Change function name from BodyNode::getCOM() to BodyNode::getLocalCOM() and add a function, BodyNode::getWorldCOM()