#include <ndt_matcher_d2d_feature.h>
Public Member Functions | |
bool | covariance (lslgeneric::NDTMap< PointTarget > &target, lslgeneric::NDTMap< PointSource > &source, Eigen::Transform< double, 3, Eigen::Affine, Eigen::ColMajor > &T, Eigen::Matrix< double, 6, 6 > &cov) |
virtual double | derivativesNDT (const std::vector< NDTCell< PointSource > * > &sourceNDT, const NDTMap< PointTarget > &targetNDT, Eigen::MatrixXd &score_gradient, Eigen::MatrixXd &Hessian, bool computeHessian) |
NDTMatcherFeatureD2D (const std::vector< std::pair< int, int > > &corr, double trimFactor=1.) | |
virtual double | scoreNDT (std::vector< lslgeneric::NDTCell< PointSource > * > &source, lslgeneric::NDTMap< PointTarget > &target, Eigen::Transform< double, 3, Eigen::Affine, Eigen::ColMajor > &T) |
Protected Attributes | |
const std::vector< std::pair < int, int > > & | _corr |
std::vector< bool > | _goodCorr |
double | _trimFactor |
This class implements NDT / NDT registration with a priory known correspondances.
Definition at line 45 of file ndt_matcher_d2d_feature.h.
lslgeneric::NDTMatcherFeatureD2D< PointSource, PointTarget >::NDTMatcherFeatureD2D | ( | const std::vector< std::pair< int, int > > & | corr, |
double | trimFactor = 1. |
||
) | [inline] |
Definition at line 48 of file ndt_matcher_d2d_feature.h.
bool lslgeneric::NDTMatcherFeatureD2D< PointSource, PointTarget >::covariance | ( | lslgeneric::NDTMap< PointTarget > & | target, |
lslgeneric::NDTMap< PointSource > & | source, | ||
Eigen::Transform< double, 3, Eigen::Affine, Eigen::ColMajor > & | T, | ||
Eigen::Matrix< double, 6, 6 > & | cov | ||
) |
Registers a point cloud to an NDT structure.
target | Reference data. |
source | The output transformation registers this point cloud to target . |
T | This is an input/output parameter. The initial value of T gives the initial pose estimate of source . When the algorithm terminates, T holds the registration result. bool match( lslgeneric::NDTMap<PointTarget>& target, lslgeneric::NDTMap<PointSource>& source, Eigen::Transform<double,3,Eigen::Affine,Eigen::ColMajor>& T); computes the covariance of the match between moving and fixed, at T. result is returned in cov |
Definition at line 258 of file ndt_matcher_d2d_feature.hpp.
double lslgeneric::NDTMatcherFeatureD2D< PointSource, PointTarget >::derivativesNDT | ( | const std::vector< NDTCell< PointSource > * > & | sourceNDT, |
const NDTMap< PointTarget > & | targetNDT, | ||
Eigen::MatrixXd & | score_gradient, | ||
Eigen::MatrixXd & | Hessian, | ||
bool | computeHessian | ||
) | [virtual] |
Reimplemented from lslgeneric::NDTMatcherD2D< PointSource, PointTarget >.
Definition at line 358 of file ndt_matcher_d2d_feature.hpp.
double lslgeneric::NDTMatcherFeatureD2D< PointSource, PointTarget >::scoreNDT | ( | std::vector< lslgeneric::NDTCell< PointSource > * > & | source, |
lslgeneric::NDTMap< PointTarget > & | target, | ||
Eigen::Transform< double, 3, Eigen::Affine, Eigen::ColMajor > & | T | ||
) | [virtual] |
Definition at line 269 of file ndt_matcher_d2d_feature.hpp.
const std::vector<std::pair<int, int> >& lslgeneric::NDTMatcherFeatureD2D< PointSource, PointTarget >::_corr [protected] |
Definition at line 111 of file ndt_matcher_d2d_feature.h.
std::vector<bool> lslgeneric::NDTMatcherFeatureD2D< PointSource, PointTarget >::_goodCorr [protected] |
Definition at line 113 of file ndt_matcher_d2d_feature.h.
double lslgeneric::NDTMatcherFeatureD2D< PointSource, PointTarget >::_trimFactor [protected] |
Definition at line 112 of file ndt_matcher_d2d_feature.h.