Funkcja powracania, poprawa wyznaczania trasy

Nowa funkcja: powracanie na miejsce startu na żądanie.
Usunięcie błędów wyznaczania trasy i celu.