Fix and improve find_nearest_visibles in nav.