Moved a lot of functionality from BreadthFirstPlanner to the World class.