Reduced the normal estimation radius, which results in better FPFH features

Introduced further hypothesis pruning by avoiding verification of already accepted correspondences