68 lines
1.8 KiB
C
68 lines
1.8 KiB
C
|
/** @file
|
||
|
|
* @brief Implementation of the virtual functor for a loop closing algorithm
|
||
|
|
* @author Jochen Sprickerhof
|
||
|
|
* @author Kai Lingemann. Institute of Computer Science, University of Osnabrueck, Germany.
|
||
|
|
* @author Andreas Nuechter. Institute of Computer Science, University of Osnabrueck, Germany.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#ifndef __LOOPSLAM6D_H__
|
||
|
|
#define __LOOPSLAM6D_H__
|
||
|
|
|
||
|
|
#include <vector>
|
||
|
|
using std::vector;
|
||
|
|
|
||
|
|
#include "icp6D.h"
|
||
|
|
#include "icp6Dminimizer.h"
|
||
|
|
#include "scan.h"
|
||
|
|
#include "graph.h"
|
||
|
|
|
||
|
|
class loopSlam6D {
|
||
|
|
|
||
|
|
public:
|
||
|
|
/**
|
||
|
|
* Constructor
|
||
|
|
* @param _quiet suppress informative output
|
||
|
|
* @param my_icp6Dminimizer the used ICP algorithm
|
||
|
|
* @param mdm maximal distance match for ICP
|
||
|
|
* @param max_num_iterations Maximal number of iterations for ICP
|
||
|
|
* @param rnd randomized point selection for ICP
|
||
|
|
* @param eP Extrapolate odometry
|
||
|
|
* @param anim animate scan matching
|
||
|
|
* @param epsilonICP the ICP epsilon
|
||
|
|
* @param nns_method the k-d tree search
|
||
|
|
*/
|
||
|
|
loopSlam6D(bool _quiet, icp6Dminimizer *my_icp6Dminimizer, double mdm, int max_num_iterations, int rnd, bool eP, int anim, double epsilonICP, int nns_method)
|
||
|
|
{
|
||
|
|
this->quiet = _quiet;
|
||
|
|
this->my_icp6D = new icp6D(my_icp6Dminimizer, mdm, max_num_iterations,
|
||
|
|
quiet, false, rnd, eP, anim, epsilonICP, nns_method);
|
||
|
|
};
|
||
|
|
|
||
|
|
/**
|
||
|
|
* Destructor
|
||
|
|
*/
|
||
|
|
virtual ~loopSlam6D() {
|
||
|
|
delete my_icp6D;
|
||
|
|
};
|
||
|
|
|
||
|
|
/**
|
||
|
|
* virtual loop closing function
|
||
|
|
* @param allScans all laser scans
|
||
|
|
* @param first index of first laser scan in the loop
|
||
|
|
* @param last indes of last laser scan in the loop
|
||
|
|
* @param g graph for loop optimization
|
||
|
|
*/
|
||
|
|
virtual void close_loop(const vector <Scan *> &allScans, int first, int last, graph_t &g) = 0;
|
||
|
|
|
||
|
|
protected:
|
||
|
|
bool quiet;
|
||
|
|
|
||
|
|
/**
|
||
|
|
* pointer to the ICP framework
|
||
|
|
*/
|
||
|
|
icp6D *my_icp6D;
|
||
|
|
|
||
|
|
};
|
||
|
|
|
||
|
|
#endif
|