Add fast FindNearestStolps function and fast recognition.