3dpcp/include/slam6d/loopSlam6D.h

68 lines
1.8 KiB
C
Raw Normal View History

2012-09-16 12:33:11 +00:00
/** @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