Dijkstra aangepast, aantal watpoints zitten er nog niet in. De avgs juis...

...t aangeroepen en de juist x y cordo. Verder methode voor move agv aangepast, er voorgezorgd dat hij de juiste begin punt weer. Eind punt is nu ook zo goed als af (alleen de dockingcranes moet nog even juist bepaald worden)