Fix BFS algo