Poprawa algorytmu chodzenia