Added back code for getting the boats current position and next waypoint position so I can calculate XTD for better tacking.