Adds check for maximum distance from waypoint to retuned line