removeDistant.h

Go to the documentation of this file.

#ifndef ATLFAST_REMOVEDISTANT_H
#define ATLFAST_REMOVEDISTANT_H


#ifndef STD_VECTOR_H
#include <vector>
#define STD_VECTOR_H
#endif
namespace Atlfast{
  template<class IsClose, class Container, class Dist >
    Container removeDistant(const Container& v, Dist dist){
      
      size_t size = v.size();
      
      Container close;
      if(size<2) {return close;}

      std::vector<bool> keep(size, false);
      bool somethingsClose = false;
      
      const typename Container::const_iterator  vbegin = v.begin();
      const typename Container::const_iterator  vend   = v.end();
      const typename std::vector<bool>::const_iterator kbegin   = keep.begin();
      
      typename Container::const_iterator voiter;
      typename Container::const_iterator viiter;
      std::vector<bool>::const_iterator kiter;
      
      for(voiter = vbegin; voiter!=vend; ++voiter){
        IsClose close(dist, *voiter);
        //    Close<double, double> close(dist, *voiter);
        for(viiter=voiter+1; viiter!=vend; ++viiter){
          if(close(*viiter)){
            keep[viiter-vbegin] = true;
            keep[voiter-vbegin] = true;
            somethingsClose     = true;
          }
          /*
            cout<<"Close "<<close<<" point "
            <<*viiter<<" result "<<close(*viiter)<<endl;
            copy(keep.begin(), keep.end(), ostream_iterator<int>(cout, " "));
            cout<<endl;
          */
        }
      }
      
      if(somethingsClose){
        size_t pos = 0;
        for(kiter=kbegin; kiter!=keep.end(); ++kiter, ++pos){
          if(*kiter) {close.push_back(v[pos]);}
        }
      }
      return close;
  }
}//namespace
#endif

---