added dijkstra try #1
changed waypoint and way