BreadthFirstPlanner should now return a functioning plan.