Ulepszenie algorytmu wyszukiwania drogi