Fixed BreadthFirstSearch