Added timer
Reversed order of querying nearestneighbours to enable flann indexing