Efficient radius neighbor search in three-dimensional point clouds
A method for registration of 3d shapes