Added function for setting new waypoints
Changed AI to use new function
Added function for drawing lines on the map