BodyNode::getWorldCOM() returns now vector from the world origin to body node origin in the world frame.