Poprawiony BFS, znajdujący ścieżkę

Program gotowy (?), należy napisać unit testy.