Planar scan matching using incident angle
Multidimensional binary search trees used for associative searching