Fix NaN values confusing closest-point search