Fix: make sure point is finite before vicinity search

There is no test ensure that the point is valid before vicinity search.