Waypoints now outputting lat & long