boxToGoalPath change to bfs