Made a move method in the AGV class that can follow a path made by Dijks...

...tra from the backend

Added debug methods that return the waypoints for that vehicle