pcl::NormalDistributionsTransform< PointSource, PointTarget > Class Template Reference

A 3D Normal Distribution Transform registration implementation for point cloud data. More...

#include <pcl/registration/ndt.h>

Inheritance diagram for pcl::NormalDistributionsTransform< PointSource, PointTarget >:
Inheritance graph
[legend]
Collaboration diagram for pcl::NormalDistributionsTransform< PointSource, PointTarget >:
Collaboration graph
[legend]

List of all members.

Public Types

typedef boost::shared_ptr
< NormalDistributionsTransform
< PointSource, PointTarget > > 		Ptr
typedef boost::shared_ptr
< const
NormalDistributionsTransform
< PointSource, PointTarget > > 		ConstPtr

Public Member Functions

 NormalDistributionsTransform ()
 Constructor.
virtual ~NormalDistributionsTransform ()
 Empty destructor.
void setInputTarget (const PointCloudTargetConstPtr &cloud)
 Provide a pointer to the input target (e.g., the point cloud that we want to align the input source to).
void setResolution (float resolution)
 Set/change the voxel grid resolution.
float getResolution () const
 Get voxel grid resolution.
double getStepSize () const
 Get the newton line search maximum step length.
void setStepSize (double step_size)
 Set/change the newton line search maximum step length.
double getOulierRatio () const
 Get the point cloud outlier ratio.
void setOulierRatio (double outlier_ratio)
 Set/change the point cloud outlier ratio.
double getTransformationProbability () const
 Get the registration alignment probability.
int getFinalNumIteration () const
 Get the number of iterations required to calculate alignment.

Static Public Member Functions

static void convertTransform (const Eigen::Matrix< double, 6, 1 > &x, Eigen::Affine3f &trans)
 Convert 6 element transformation vector to affine transformation.
static void convertTransform (const Eigen::Matrix< double, 6, 1 > &x, Eigen::Matrix4f &trans)
 Convert 6 element transformation vector to transformation matrix.

Protected Types

typedef Registration
< PointSource, PointTarget >
::PointCloudSource 		PointCloudSource
typedef PointCloudSource::Ptr PointCloudSourcePtr
typedef PointCloudSource::ConstPtr PointCloudSourceConstPtr
typedef Registration
< PointSource, PointTarget >
::PointCloudTarget 		PointCloudTarget
typedef PointCloudTarget::Ptr PointCloudTargetPtr
typedef PointCloudTarget::ConstPtr PointCloudTargetConstPtr
typedef PointIndices::Ptr PointIndicesPtr
typedef PointIndices::ConstPtr PointIndicesConstPtr
typedef VoxelGridCovariance
< PointTarget > 		TargetGrid
 Typename of searchable voxel grid containing mean and covariance.
typedef TargetGrid * TargetGridPtr
 Typename of pointer to searchable voxel grid.
typedef const TargetGrid * TargetGridConstPtr
 Typename of const pointer to searchable voxel grid.
typedef TargetGrid::LeafConstPtr TargetGridLeafConstPtr
 Typename of const pointer to searchable voxel grid leaf.

Protected Member Functions

virtual void computeTransformation (PointCloudSource &output)
 Estimate the transformation and returns the transformed source (input) as output.
virtual void computeTransformation (PointCloudSource &output, const Eigen::Matrix4f &guess)
 Estimate the transformation and returns the transformed source (input) as output.
void init ()
 Initiate covariance voxel structure.
double computeDerivatives (Eigen::Matrix< double, 6, 1 > &score_gradient, Eigen::Matrix< double, 6, 6 > &hessian, PointCloudSource &trans_cloud, Eigen::Matrix< double, 6, 1 > &p, bool compute_hessian=true)
 Compute derivatives of probability function w.r.t.
double updateDerivatives (Eigen::Matrix< double, 6, 1 > &score_gradient, Eigen::Matrix< double, 6, 6 > &hessian, Eigen::Vector3d &x_trans, Eigen::Matrix3d &c_inv, bool compute_hessian=true)
 Compute individual point contirbutions to derivatives of probability function w.r.t.
void computeAngleDerivatives (Eigen::Matrix< double, 6, 1 > &p, bool compute_hessian=true)
 Precompute anglular components of derivatives.
void computePointDerivatives (Eigen::Vector3d &x, bool compute_hessian=true)
 Compute point derivatives.
void computeHessian (Eigen::Matrix< double, 6, 6 > &hessian, PointCloudSource &trans_cloud, Eigen::Matrix< double, 6, 1 > &p)
 Compute hessian of probability function w.r.t.
void updateHessian (Eigen::Matrix< double, 6, 6 > &hessian, Eigen::Vector3d &x_trans, Eigen::Matrix3d &c_inv)
 Compute individual point contirbutions to hessian of probability function w.r.t.
double computeStepLengthMT (const Eigen::Matrix< double, 6, 1 > &x, Eigen::Matrix< double, 6, 1 > &step_dir, double step_init, double step_max, double step_min, double &score, Eigen::Matrix< double, 6, 1 > &score_gradient, Eigen::Matrix< double, 6, 6 > &hessian, PointCloudSource &trans_cloud)
 Compute line search step length and update transform and probability derivatives using More-Thuente method.
bool updateIntervalMT (double &a_l, double &f_l, double &g_l, double &a_u, double &f_u, double &g_u, double a_t, double f_t, double g_t)
 Update interval of possible step lengths for More-Thuente method, $ I $ in More-Thuente (1994).
double trialValueSelectionMT (double a_l, double f_l, double g_l, double a_u, double f_u, double g_u, double a_t, double f_t, double g_t)
 Select new trial value for More-Thuente method.
double auxilaryFunction_PsiMT (double a, double f_a, double f_0, double g_0, double mu=1.e-4)
 Auxilary function used to determin endpoints of More-Thuente interval.
double auxilaryFunction_dPsiMT (double g_a, double g_0, double mu=1.e-4)
 Auxilary function derivative used to determin endpoints of More-Thuente interval.

Protected Attributes

TargetGrid target_cells_
 The voxel grid generated from target cloud containing point means and covariances.
float resolution_
 The side length of voxels.
double step_size_
 The maximum step length.
double outlier_ratio_
 The ratio of outliers of points w.r.t.
double gauss_d1_
 The normalization constants used fit the point distribution to a normal distribution, Equation 6.8 [Magnusson 2009].
double gauss_d2_
double trans_probability_
 The probability score of the transform applied to the input cloud, Equation 6.9 and 6.10 [Magnusson 2009].
Eigen::Vector3d j_ang_a_
 Precomputed Angular Gradient.
Eigen::Vector3d j_ang_b_
Eigen::Vector3d j_ang_c_
Eigen::Vector3d j_ang_d_
Eigen::Vector3d j_ang_e_
Eigen::Vector3d j_ang_f_
Eigen::Vector3d j_ang_g_
Eigen::Vector3d j_ang_h_
Eigen::Vector3d h_ang_a2_
 Precomputed Angular Hessian.
Eigen::Vector3d h_ang_a3_
Eigen::Vector3d h_ang_b2_
Eigen::Vector3d h_ang_b3_
Eigen::Vector3d h_ang_c2_
Eigen::Vector3d h_ang_c3_
Eigen::Vector3d h_ang_d1_
Eigen::Vector3d h_ang_d2_
Eigen::Vector3d h_ang_d3_
Eigen::Vector3d h_ang_e1_
Eigen::Vector3d h_ang_e2_
Eigen::Vector3d h_ang_e3_
Eigen::Vector3d h_ang_f1_
Eigen::Vector3d h_ang_f2_
Eigen::Vector3d h_ang_f3_
Eigen::Matrix< double, 3, 6 > point_gradient_
 The first order derivative of the transformation of a point w.r.t.
Eigen::Matrix< double, 18, 6 > point_hessian_
 The second order derivative of the transformation of a point w.r.t.

Detailed Description

template<typename PointSource, typename PointTarget>
class pcl::NormalDistributionsTransform< PointSource, PointTarget >

A 3D Normal Distribution Transform registration implementation for point cloud data.

Note:
For more information please see Magnusson, M. (2009). The Three-Dimensional Normal-Distributions Transform — an Efficient Representation for Registration, Surface Analysis, and Loop Detection. PhD thesis, Orebro University. Orebro Studies in Technology 36., More, J., and Thuente, D. (1994). Line Search Algorithm with Guaranteed Sufficient Decrease In ACM Transactions on Mathematical Software. and Sun, W. and Yuan, Y, (2006) Optimization Theory and Methods: Nonlinear Programming. 89-100
Math refactored by Todor Stoyanov.
Author:
Brian Okorn (Space and Naval Warfare Systems Center Pacific)

Definition at line 63 of file ndt.h.

Member Typedef Documentation

template<typename PointSource , typename PointTarget >
typedef boost::shared_ptr< const NormalDistributionsTransform<PointSource, PointTarget> > pcl::NormalDistributionsTransform< PointSource, PointTarget >::ConstPtr

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 91 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef Registration<PointSource, PointTarget>::PointCloudSource pcl::NormalDistributionsTransform< PointSource, PointTarget >::PointCloudSource [protected]

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 67 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef PointCloudSource::ConstPtr pcl::NormalDistributionsTransform< PointSource, PointTarget >::PointCloudSourceConstPtr [protected]

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 69 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef PointCloudSource::Ptr pcl::NormalDistributionsTransform< PointSource, PointTarget >::PointCloudSourcePtr [protected]

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 68 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef Registration<PointSource, PointTarget>::PointCloudTarget pcl::NormalDistributionsTransform< PointSource, PointTarget >::PointCloudTarget [protected]

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 71 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef PointCloudTarget::ConstPtr pcl::NormalDistributionsTransform< PointSource, PointTarget >::PointCloudTargetConstPtr [protected]

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 73 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef PointCloudTarget::Ptr pcl::NormalDistributionsTransform< PointSource, PointTarget >::PointCloudTargetPtr [protected]

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 72 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef PointIndices::ConstPtr pcl::NormalDistributionsTransform< PointSource, PointTarget >::PointIndicesConstPtr [protected]

Reimplemented from pcl::PCLBase< PointSource >.

Definition at line 76 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef PointIndices::Ptr pcl::NormalDistributionsTransform< PointSource, PointTarget >::PointIndicesPtr [protected]

Reimplemented from pcl::PCLBase< PointSource >.

Definition at line 75 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef boost::shared_ptr< NormalDistributionsTransform<PointSource, PointTarget> > pcl::NormalDistributionsTransform< PointSource, PointTarget >::Ptr

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 90 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef VoxelGridCovariance<PointTarget> pcl::NormalDistributionsTransform< PointSource, PointTarget >::TargetGrid [protected]

Typename of searchable voxel grid containing mean and covariance.

Definition at line 79 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef const TargetGrid* pcl::NormalDistributionsTransform< PointSource, PointTarget >::TargetGridConstPtr [protected]

Typename of const pointer to searchable voxel grid.

Definition at line 83 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef TargetGrid::LeafConstPtr pcl::NormalDistributionsTransform< PointSource, PointTarget >::TargetGridLeafConstPtr [protected]

Typename of const pointer to searchable voxel grid leaf.

Definition at line 85 of file ndt.h.

template<typename PointSource , typename PointTarget >
typedef TargetGrid* pcl::NormalDistributionsTransform< PointSource, PointTarget >::TargetGridPtr [protected]

Typename of pointer to searchable voxel grid.

Definition at line 81 of file ndt.h.

Constructor & Destructor Documentation

template<typename PointSource , typename PointTarget >
pcl::NormalDistributionsTransform< PointSource, PointTarget >::NormalDistributionsTransform (  )  [inline]

Constructor.

Sets outlier_ratio_ to 0.35, step_size_ to 0.05 and resolution_ to 1.0

Definition at line 46 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d2_, pcl::Registration< PointSource, PointTarget >::max_iterations_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::outlier_ratio_, pcl::Registration< PointSource, PointTarget >::reg_name_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::resolution_, and pcl::Registration< PointSource, PointTarget >::transformation_epsilon_.

template<typename PointSource , typename PointTarget >
virtual pcl::NormalDistributionsTransform< PointSource, PointTarget >::~NormalDistributionsTransform (  )  [inline, virtual]

Empty destructor.

Definition at line 100 of file ndt.h.

Member Function Documentation

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::auxilaryFunction_dPsiMT ( double  g_a,
double  g_0,
double  mu = 1.e-4 
) [inline, protected]

Auxilary function derivative used to determin endpoints of More-Thuente interval.

Note:
$ \psi'(\alpha) $, derivative of Equation 1.6 (Moore, Thuente 1994)
Parameters:
[in] g_a function gradient at step length a, $ \phi'(\alpha) $ in More-Thuente (1994)
[in] g_0 initial function gradiant, $ \phi'(0) $ in More-Thuente (1994)
[in] mu the step length, constant $ \mu $ in Equation 1.1 [More, Thuente 1994]
Returns:
sufficent decrease derivative

Definition at line 412 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeStepLengthMT().

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::auxilaryFunction_PsiMT ( double  a,
double  f_a,
double  f_0,
double  g_0,
double  mu = 1.e-4 
) [inline, protected]

Auxilary function used to determin endpoints of More-Thuente interval.

Note:
$ \psi(\alpha) $ in Equation 1.6 (Moore, Thuente 1994)
Parameters:
[in] a the step length, $ \alpha $ in More-Thuente (1994)
[in] f_a function value at step length a, $ \phi(\alpha) $ in More-Thuente (1994)
[in] f_0 initial function value, $ \phi(0) $ in Moore-Thuente (1994)
[in] g_0 initial function gradiant, $ \phi'(0) $ in More-Thuente (1994)
[in] mu the step length, constant $ \mu $ in Equation 1.1 [More, Thuente 1994]
Returns:
sufficent decrease value

Definition at line 399 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeStepLengthMT().

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives ( Eigen::Matrix< double, 6, 1 > &  p,
bool  compute_hessian = true 
) [inline, protected]

Precompute anglular components of derivatives.

Note:
Equation 6.19 and 6.21 [Magnusson 2009].
Parameters:
[in] p the current transform vector
[in] compute_hessian flag to calculate hessian, unnessissary for step calculation.

Definition at line 233 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_a2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_a3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_b2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_b3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_c2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_c3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_a_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_b_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_c_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_d_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_e_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_f_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_g_, and pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_h_.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeDerivatives().

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeDerivatives ( Eigen::Matrix< double, 6, 1 > &  score_gradient,
Eigen::Matrix< double, 6, 6 > &  hessian,
PointCloudSource &  trans_cloud,
Eigen::Matrix< double, 6, 1 > &  p,
bool  compute_hessian = true 
) [inline, protected]

Compute derivatives of probability function w.r.t.

the transformation vector.

Note:
Equation 6.10, 6.12 and 6.13 [Magnusson 2009].
Parameters:
[out] score_gradient the gradient vector of the probability function w.r.t. the transformation vector
[out] hessian the hessian matrix of the probability function w.r.t. the transformation vector
[in] trans_cloud transformed point cloud
[in] p the current transform vector
[in] compute_hessian flag to calculate hessian, unnessissary for step calculation.

Definition at line 176 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives(), pcl::PCLBase< PointSource >::input_, pcl::VoxelGridCovariance< PointT >::radiusSearch(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::resolution_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::target_cells_, and pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateDerivatives().

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeStepLengthMT(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation().

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeHessian ( Eigen::Matrix< double, 6, 6 > &  hessian,
PointCloudSource &  trans_cloud,
Eigen::Matrix< double, 6, 1 > &  p 
) [inline, protected]

Compute hessian of probability function w.r.t.

the transformation vector.

Note:
Equation 6.13 [Magnusson 2009].
Parameters:
[out] hessian the hessian matrix of the probability function w.r.t. the transformation vector
[in] trans_cloud transformed point cloud
[in] p the current transform vector

Definition at line 397 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives(), pcl::PCLBase< PointSource >::input_, pcl::VoxelGridCovariance< PointT >::radiusSearch(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::resolution_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::target_cells_, and pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateHessian().

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeStepLengthMT().

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives ( Eigen::Vector3d &  x,
bool  compute_hessian = true 
) [inline, protected]

Compute point derivatives.

Note:
Equation 6.18-21 [Magnusson 2009].
Parameters:
[in] x point from the input cloud
[in] compute_hessian flag to calculate hessian, unnessissary for step calculation.

Definition at line 310 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_a2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_a3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_b2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_b3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_c2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_c3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f3_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_a_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_b_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_c_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_d_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_e_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_f_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_g_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_h_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_gradient_, and pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_hessian_.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeHessian().

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeStepLengthMT ( const Eigen::Matrix< double, 6, 1 > &  x,
Eigen::Matrix< double, 6, 1 > &  step_dir,
double  step_init,
double  step_max,
double  step_min,
double &  score,
Eigen::Matrix< double, 6, 1 > &  score_gradient,
Eigen::Matrix< double, 6, 6 > &  hessian,
PointCloudSource &  trans_cloud 
) [inline, protected]

Compute line search step length and update transform and probability derivatives using More-Thuente method.

Note:
Search Algorithm [More, Thuente 1994]
Parameters:
[in] x initial transformation vector, $ x $ in Equation 1.3 (Moore, Thuente 1994) and $ \vec{p} $ in Algorithm 2 [Magnusson 2009]
[in] step_dir descent direction, $ p $ in Equation 1.3 (Moore, Thuente 1994) and $ \delta \vec{p} $ normalized in Algorithm 2 [Magnusson 2009]
[in] step_init initial step length estimate, $ \alpha_0 $ in Moore-Thuente (1994) and the noramal of $ \delta \vec{p} $ in Algorithm 2 [Magnusson 2009]
[in] step_max maximum step length, $ \alpha_max $ in Moore-Thuente (1994)
[in] step_min minimum step length, $ \alpha_min $ in Moore-Thuente (1994)
[out] score final score function value, $ f(x + \alpha p) $ in Equation 1.3 (Moore, Thuente 1994) and $ score $ in Algorithm 2 [Magnusson 2009]
[in,out] score_gradient gradient of score function w.r.t. transformation vector, $ f'(x + \alpha p) $ in Moore-Thuente (1994) and $ \vec{g} $ in Algorithm 2 [Magnusson 2009]
[out] hessian hessian of score function w.r.t. transformation vector, $ f''(x + \alpha p) $ in Moore-Thuente (1994) and $ H $ in Algorithm 2 [Magnusson 2009]
[in,out] trans_cloud transformed point cloud, $ X $ transformed by $ T(\vec{p},\vec{x}) $ in Algorithm 2 [Magnusson 2009]
Returns:
final step length

Definition at line 604 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::auxilaryFunction_dPsiMT(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::auxilaryFunction_PsiMT(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeDerivatives(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeHessian(), pcl::Registration< PointSource, PointTarget >::final_transformation_, pcl::PCLBase< PointSource >::input_, pcl::transformPointCloud(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::trialValueSelectionMT(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateIntervalMT().

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation().

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation ( PointCloudSource &  output,
const Eigen::Matrix4f &  guess 
) [inline, protected, virtual]

Estimate the transformation and returns the transformed source (input) as output.

Parameters:
[out] output the resultant input transfomed point cloud dataset
[in] guess the initial gross estimation of the transformation

Definition at line 77 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeDerivatives(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeStepLengthMT(), pcl::Registration< PointSource, PointTarget >::converged_, pcl::Registration< PointSource, PointTarget >::final_transformation_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d2_, pcl::PCLBase< PointSource >::input_, pcl::Registration< PointSource, PointTarget >::max_iterations_, pcl::Registration< PointSource, PointTarget >::nr_iterations_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::outlier_ratio_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_gradient_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_hessian_, pcl::Registration< PointSource, PointTarget >::previous_transformation_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::resolution_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::step_size_, pcl::Registration< PointSource, PointTarget >::target_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::trans_probability_, pcl::Registration< PointSource, PointTarget >::transformation_, pcl::Registration< PointSource, PointTarget >::transformation_epsilon_, pcl::transformPointCloud(), and pcl::Registration< PointSource, PointTarget >::update_visualizer_.

template<typename PointSource , typename PointTarget >
virtual void pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation ( PointCloudSource &  output  )  [inline, protected, virtual]

Estimate the transformation and returns the transformed source (input) as output.

Parameters:
[out] output the resultant input transfomed point cloud dataset

Definition at line 238 of file ndt.h.

template<typename PointSource , typename PointTarget >
static void pcl::NormalDistributionsTransform< PointSource, PointTarget >::convertTransform ( const Eigen::Matrix< double, 6, 1 > &  x,
Eigen::Matrix4f &  trans 
) [inline, static]

Convert 6 element transformation vector to transformation matrix.

Parameters:
[in] x transformation vector of the form [x, y, z, roll, pitch, yaw]
[out] trans 4x4 transformation matrix corresponding to given transfomation vector

Definition at line 208 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::convertTransform().

template<typename PointSource , typename PointTarget >
static void pcl::NormalDistributionsTransform< PointSource, PointTarget >::convertTransform ( const Eigen::Matrix< double, 6, 1 > &  x,
Eigen::Affine3f &  trans 
) [inline, static]

Convert 6 element transformation vector to affine transformation.

Parameters:
[in] x transformation vector of the form [x, y, z, roll, pitch, yaw]
[out] trans affine transform corresponding to given transfomation vector

Definition at line 195 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::convertTransform().

template<typename PointSource , typename PointTarget >
int pcl::NormalDistributionsTransform< PointSource, PointTarget >::getFinalNumIteration (  )  const [inline]

Get the number of iterations required to calculate alignment.

Returns:
final number of iterations

Definition at line 185 of file ndt.h.

References pcl::Registration< PointSource, PointTarget >::nr_iterations_.

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::getOulierRatio (  )  const [inline]

Get the point cloud outlier ratio.

Returns:
outlier ratio

Definition at line 158 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::outlier_ratio_.

template<typename PointSource , typename PointTarget >
float pcl::NormalDistributionsTransform< PointSource, PointTarget >::getResolution (  )  const [inline]

Get voxel grid resolution.

Returns:
side length of voxels

Definition at line 131 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::resolution_.

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::getStepSize (  )  const [inline]

Get the newton line search maximum step length.

Returns:
maximum step length

Definition at line 140 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::step_size_.

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::getTransformationProbability (  )  const [inline]

Get the registration alignment probability.

Returns:
transformation probability

Definition at line 176 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::trans_probability_.

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::init (  )  [inline, protected]

Initiate covariance voxel structure.

Definition at line 252 of file ndt.h.

References pcl::VoxelGridCovariance< PointT >::filter(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::resolution_, pcl::PCLBase< PointT >::setInputCloud(), pcl::VoxelGrid< PointT >::setLeafSize(), pcl::Registration< PointSource, PointTarget >::target_, and pcl::NormalDistributionsTransform< PointSource, PointTarget >::target_cells_.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::setInputTarget(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::setResolution().

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::setInputTarget ( const PointCloudTargetConstPtr &  cloud  )  [inline, virtual]

Provide a pointer to the input target (e.g., the point cloud that we want to align the input source to).

Parameters:
[in] cloud the input point cloud target

Reimplemented from pcl::Registration< PointSource, PointTarget >.

Definition at line 106 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::init().

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::setOulierRatio ( double  outlier_ratio  )  [inline]

Set/change the point cloud outlier ratio.

Parameters:
[in] outlier_ratio outlier ratio

Definition at line 167 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::outlier_ratio_.

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::setResolution ( float  resolution  )  [inline]

Set/change the voxel grid resolution.

Parameters:
[in] resolution side length of voxels

Definition at line 116 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::init(), pcl::PCLBase< PointSource >::input_, and pcl::NormalDistributionsTransform< PointSource, PointTarget >::resolution_.

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::setStepSize ( double  step_size  )  [inline]

Set/change the newton line search maximum step length.

Parameters:
[in] step_size maximum step length

Definition at line 149 of file ndt.h.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::step_size_.

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::trialValueSelectionMT ( double  a_l,
double  f_l,
double  g_l,
double  a_u,
double  f_u,
double  g_u,
double  a_t,
double  f_t,
double  g_t 
) [inline, protected]

Select new trial value for More-Thuente method.

Note:
Trial Value Selection [More, Thuente 1994], $ \psi(\alpha_k) $ is used for $ f_k $ and $ g_k $ until some value satifies the test $ \psi(\alpha_k) \leq 0 $ and $ \phi'(\alpha_k) \geq 0 $ then $ \phi(\alpha_k) $ is used from then on.
Interpolation Minimizer equations from Optimization Theory and Methods: Nonlinear Programming By Wenyu Sun, Ya-xiang Yuan (89-100).< >
Parameters:
[in] a_l first endpoint of interval $ I $, $ \alpha_l $ in Moore-Thuente (1994)
[in] f_l value at first endpoint, $ f_l $ in Moore-Thuente (1994)
[in] g_l derivative at first endpoint, $ g_l $ in Moore-Thuente (1994)
[in] a_u second endpoint of interval $ I $, $ \alpha_u $ in Moore-Thuente (1994)
[in] f_u value at second endpoint, $ f_u $ in Moore-Thuente (1994)
[in] g_u derivative at second endpoint, $ g_u $ in Moore-Thuente (1994)
[in] a_t previous trial value, $ \alpha_t $ in Moore-Thuente (1994)
[in] f_t value at previous trial value, $ f_t $ in Moore-Thuente (1994)
[in] g_t derivative at previous trial value, $ g_t $ in Moore-Thuente (1994)
Returns:
new trial value

Definition at line 521 of file ndt.hpp.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeStepLengthMT().

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateDerivatives ( Eigen::Matrix< double, 6, 1 > &  score_gradient,
Eigen::Matrix< double, 6, 6 > &  hessian,
Eigen::Vector3d &  x_trans,
Eigen::Matrix3d &  c_inv,
bool  compute_hessian = true 
) [inline, protected]

Compute individual point contirbutions to derivatives of probability function w.r.t.

the transformation vector.

Note:
Equation 6.10, 6.12 and 6.13 [Magnusson 2009].
Parameters:
[in,out] score_gradient the gradient vector of the probability function w.r.t. the transformation vector
[in,out] hessian the hessian matrix of the probability function w.r.t. the transformation vector
[in] x_trans transformed point minus mean of occupied covariance voxel
[in] c_inv covariance of occupied covariance voxel
[in] compute_hessian flag to calculate hessian, unnessissary for step calculation.

Definition at line 351 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_gradient_, and pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_hessian_.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeDerivatives().

template<typename PointSource , typename PointTarget >
void pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateHessian ( Eigen::Matrix< double, 6, 6 > &  hessian,
Eigen::Vector3d &  x_trans,
Eigen::Matrix3d &  c_inv 
) [inline, protected]

Compute individual point contirbutions to hessian of probability function w.r.t.

the transformation vector.

Note:
Equation 6.13 [Magnusson 2009].
Parameters:
[in,out] hessian the hessian matrix of the probability function w.r.t. the transformation vector
[in] x_trans transformed point minus mean of occupied covariance voxel
[in] c_inv covariance of occupied covariance voxel

Definition at line 449 of file ndt.hpp.

References pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d1_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d2_, pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_gradient_, and pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_hessian_.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeHessian().

template<typename PointSource , typename PointTarget >
bool pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateIntervalMT ( double &  a_l,
double &  f_l,
double &  g_l,
double &  a_u,
double &  f_u,
double &  g_u,
double  a_t,
double  f_t,
double  g_t 
) [inline, protected]

Update interval of possible step lengths for More-Thuente method, $ I $ in More-Thuente (1994).

Note:
Updating Algorithm until some value satifies $ \psi(\alpha_k) \leq 0 $ and $ \phi'(\alpha_k) \geq 0 $ and Modified Updating Algorithm from then on [More, Thuente 1994].
Parameters:
[in,out] a_l first endpoint of interval $ I $, $ \alpha_l $ in Moore-Thuente (1994)
[in,out] f_l value at first endpoint, $ f_l $ in Moore-Thuente (1994), $ \psi(\alpha_l) $ for Update Algorithm and $ \phi(\alpha_l) $ for Modified Update Algorithm
[in,out] g_l derivative at first endpoint, $ g_l $ in Moore-Thuente (1994), $ \psi'(\alpha_l) $ for Update Algorithm and $ \phi'(\alpha_l) $ for Modified Update Algorithm
[in,out] a_u second endpoint of interval $ I $, $ \alpha_u $ in Moore-Thuente (1994)
[in,out] f_u value at second endpoint, $ f_u $ in Moore-Thuente (1994), $ \psi(\alpha_u) $ for Update Algorithm and $ \phi(\alpha_u) $ for Modified Update Algorithm
[in,out] g_u derivative at second endpoint, $ g_u $ in Moore-Thuente (1994), $ \psi'(\alpha_u) $ for Update Algorithm and $ \phi'(\alpha_u) $ for Modified Update Algorithm
[in] a_t trial value, $ \alpha_t $ in Moore-Thuente (1994)
[in] f_t value at trial value, $ f_t $ in Moore-Thuente (1994), $ \psi(\alpha_t) $ for Update Algorithm and $ \phi(\alpha_t) $ for Modified Update Algorithm
[in] g_t derivative at trial value, $ g_t $ in Moore-Thuente (1994), $ \psi'(\alpha_t) $ for Update Algorithm and $ \phi'(\alpha_t) $ for Modified Update Algorithm
Returns:
if interval converges

Definition at line 480 of file ndt.hpp.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeStepLengthMT().

Member Data Documentation

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d1_ [protected]

The normalization constants used fit the point distribution to a normal distribution, Equation 6.8 [Magnusson 2009].

Definition at line 432 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::NormalDistributionsTransform(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateHessian().

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::gauss_d2_ [protected]

Definition at line 432 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::NormalDistributionsTransform(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateHessian().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_a2_ [protected]

Precomputed Angular Hessian.

The precomputed angular derivatives for the hessian of a transformation vector, Equation 6.19 [Magnusson 2009].

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_a3_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_b2_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_b3_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_c2_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_c3_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d1_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d2_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_d3_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e1_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e2_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_e3_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f1_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f2_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::h_ang_f3_ [protected]

Definition at line 447 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_a_ [protected]

Precomputed Angular Gradient.

The precomputed angular derivatives for the jacobian of a transformation vector, Equation 6.19 [Magnusson 2009].

Definition at line 441 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_b_ [protected]

Definition at line 441 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_c_ [protected]

Definition at line 441 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_d_ [protected]

Definition at line 441 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_e_ [protected]

Definition at line 441 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_f_ [protected]

Definition at line 441 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_g_ [protected]

Definition at line 441 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
Eigen::Vector3d pcl::NormalDistributionsTransform< PointSource, PointTarget >::j_ang_h_ [protected]

Definition at line 441 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeAngleDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives().

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::outlier_ratio_ [protected]

The ratio of outliers of points w.r.t.

a normal distribution, Equation 6.7 [Magnusson 2009].

Definition at line 429 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::getOulierRatio(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::NormalDistributionsTransform(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::setOulierRatio().

template<typename PointSource , typename PointTarget >
Eigen::Matrix<double, 3, 6> pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_gradient_ [protected]

The first order derivative of the transformation of a point w.r.t.

the transform vector, $ J_E $ in Equation 6.18 [Magnusson 2009].

Definition at line 455 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateHessian().

template<typename PointSource , typename PointTarget >
Eigen::Matrix<double, 18, 6> pcl::NormalDistributionsTransform< PointSource, PointTarget >::point_hessian_ [protected]

The second order derivative of the transformation of a point w.r.t.

the transform vector, $ H_E $ in Equation 6.20 [Magnusson 2009].

Definition at line 458 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computePointDerivatives(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateDerivatives(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::updateHessian().

template<typename PointSource , typename PointTarget >
float pcl::NormalDistributionsTransform< PointSource, PointTarget >::resolution_ [protected]

The side length of voxels.

Definition at line 423 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeDerivatives(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeHessian(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::getResolution(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::init(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::NormalDistributionsTransform(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::setResolution().

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::step_size_ [protected]

The maximum step length.

Definition at line 426 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::getStepSize(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::setStepSize().

template<typename PointSource , typename PointTarget >
TargetGrid pcl::NormalDistributionsTransform< PointSource, PointTarget >::target_cells_ [protected]

The voxel grid generated from target cloud containing point means and covariances.

Definition at line 418 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeDerivatives(), pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeHessian(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::init().

template<typename PointSource , typename PointTarget >
double pcl::NormalDistributionsTransform< PointSource, PointTarget >::trans_probability_ [protected]

The probability score of the transform applied to the input cloud, Equation 6.9 and 6.10 [Magnusson 2009].

Definition at line 435 of file ndt.h.

Referenced by pcl::NormalDistributionsTransform< PointSource, PointTarget >::computeTransformation(), and pcl::NormalDistributionsTransform< PointSource, PointTarget >::getTransformationProbability().

The documentation for this class was generated from the following files:
 All Classes Namespaces Functions Variables Typedefs Enumerations Enumerator Friends