#include <scanmatcher.h>
Public Types | |
typedef Covariance3 | CovarianceMatrix |
Public Member Functions | |
void | computeActiveArea (ScanMatcherMap &map, const OrientedPoint &p, const double *readings) |
double | icpOptimize (OrientedPoint &pnew, const ScanMatcherMap &map, const OrientedPoint &p, const double *readings) const |
double | icpStep (OrientedPoint &pret, const ScanMatcherMap &map, const OrientedPoint &p, const double *readings) const |
void | invalidateActiveArea () |
const double * | laserAngles () const |
unsigned int | laserBeams () const |
double | likelihood (double &lmax, OrientedPoint &mean, CovarianceMatrix &cov, const ScanMatcherMap &map, const OrientedPoint &p, const double *readings) |
double | likelihood (double &_lmax, OrientedPoint &_mean, CovarianceMatrix &_cov, const ScanMatcherMap &map, const OrientedPoint &p, Gaussian3 &odometry, const double *readings, double gain=180.) |
unsigned int | likelihoodAndScore (double &s, double &l, const ScanMatcherMap &map, const OrientedPoint &p, const double *readings) const |
double | optimize (OrientedPoint &pnew, const ScanMatcherMap &map, const OrientedPoint &p, const double *readings) const |
double | optimize (OrientedPoint &mean, CovarianceMatrix &cov, const ScanMatcherMap &map, const OrientedPoint &p, const double *readings) const |
double | registerScan (ScanMatcherMap &map, const OrientedPoint &p, const double *readings) |
ScanMatcher () | |
double | score (const ScanMatcherMap &map, const OrientedPoint &p, const double *readings) const |
void | setLaserParameters (unsigned int beams, double *angles, const OrientedPoint &lpose) |
void | setMatchingParameters (double urange, double range, double sigma, int kernsize, double lopt, double aopt, int iterations, double likelihoodSigma=1, unsigned int likelihoodSkip=0) |
~ScanMatcher () | |
Static Public Attributes | |
static const double | nullLikelihood =-.5 |
Protected Attributes | |
bool | m_activeAreaComputed |
double | m_laserAngles [LASER_MAXBEAMS] |
unsigned int | m_laserBeams |
IntPoint * | m_linePoints |
Definition at line 14 of file scanmatcher.h.
Definition at line 16 of file scanmatcher.h.
GMapping::ScanMatcher::ScanMatcher | ( | ) |
Definition at line 16 of file scanmatcher.cpp.
GMapping::ScanMatcher::~ScanMatcher | ( | ) |
Definition at line 53 of file scanmatcher.cpp.
void GMapping::ScanMatcher::computeActiveArea | ( | ScanMatcherMap & | map, |
const OrientedPoint & | p, | ||
const double * | readings | ||
) |
Definition at line 116 of file scanmatcher.cpp.
double GMapping::ScanMatcher::icpOptimize | ( | OrientedPoint & | pnew, |
const ScanMatcherMap & | map, | ||
const OrientedPoint & | p, | ||
const double * | readings | ||
) | const |
Definition at line 319 of file scanmatcher.cpp.
|
inline |
Definition at line 76 of file scanmatcher.h.
void GMapping::ScanMatcher::invalidateActiveArea | ( | ) |
Definition at line 57 of file scanmatcher.cpp.
|
inline |
Definition at line 37 of file scanmatcher.h.
|
inline |
Definition at line 38 of file scanmatcher.h.
double GMapping::ScanMatcher::likelihood | ( | double & | lmax, |
OrientedPoint & | mean, | ||
CovarianceMatrix & | cov, | ||
const ScanMatcherMap & | map, | ||
const OrientedPoint & | p, | ||
const double * | readings | ||
) |
Definition at line 572 of file scanmatcher.cpp.
double GMapping::ScanMatcher::likelihood | ( | double & | _lmax, |
OrientedPoint & | _mean, | ||
CovarianceMatrix & | _cov, | ||
const ScanMatcherMap & | map, | ||
const OrientedPoint & | p, | ||
Gaussian3 & | odometry, | ||
const double * | readings, | ||
double | gain = 180. |
||
) |
Definition at line 639 of file scanmatcher.cpp.
|
inline |
Definition at line 191 of file scanmatcher.h.
double GMapping::ScanMatcher::optimize | ( | OrientedPoint & | pnew, |
const ScanMatcherMap & | map, | ||
const OrientedPoint & | p, | ||
const double * | readings | ||
) | const |
Definition at line 337 of file scanmatcher.cpp.
double GMapping::ScanMatcher::optimize | ( | OrientedPoint & | mean, |
ScanMatcher::CovarianceMatrix & | _cov, | ||
const ScanMatcherMap & | map, | ||
const OrientedPoint & | p, | ||
const double * | readings | ||
) | const |
Definition at line 430 of file scanmatcher.cpp.
void GMapping::ScanMatcher::registerScan | ( | ScanMatcherMap & | map, |
const OrientedPoint & | p, | ||
const double * | readings | ||
) |
Definition at line 215 of file scanmatcher.cpp.
|
inline |
Definition at line 143 of file scanmatcher.h.
void GMapping::ScanMatcher::setLaserParameters | ( | unsigned int | beams, |
double * | angles, | ||
const OrientedPoint & | lpose | ||
) |
Definition at line 559 of file scanmatcher.cpp.
void GMapping::ScanMatcher::setMatchingParameters | ( | double | urange, |
double | range, | ||
double | sigma, | ||
int | kernsize, | ||
double | lopt, | ||
double | aopt, | ||
int | iterations, | ||
double | likelihoodSigma = 1 , |
||
unsigned int | likelihoodSkip = 0 |
||
) |
Definition at line 712 of file scanmatcher.cpp.
|
protected |
Definition at line 43 of file scanmatcher.h.
|
protected |
Definition at line 47 of file scanmatcher.h.
|
protected |
laser parameters
Definition at line 46 of file scanmatcher.h.
|
protected |
scan_matcher parameters
Definition at line 73 of file scanmatcher.h.
|
static |
Definition at line 40 of file scanmatcher.h.