Dijkstra routine working
Destination is updating correctly