changed "<" to "<=" in selection in icp to avoid empty selection if all vertices have the same distance.