Changed the navigation node to accomodate heading updates when outliers are rejected.