Tool for publishing a MoveIt! PlanningSceneWorld defined in a XML file