BFS implemented, finding solution path