Updates for nav_to_coord_dist