small correction brute force

Author: nuechter

src/slam6d/BruteForceNotATree.cc

@@ -8,6 +8,7 @@
  */
 
 #include "slam6d/BruteForceNotATree.h"
+#include "slam6d/globals.icc"
 #include <limits.h>
 
 /**
@@ -63,6 +64,7 @@ double *BruteForceNotATree::FindClosest(double *_p, double maxdist2, int threadN
       idx      = i;
     }
   }
-
+  
+  if (Dist2(_p, pts[idx]) > maxdist2) return 0;
   return pts[idx];
 }