Gets angle needed to head from location and next waypoint, next implement removing of waypoints that have been reached.