39 #include <pcl/registration/ia_fpcs.h> 43 namespace registration
53 template <
typename Po
intSource,
typename Po
intTarget,
typename NormalT = pcl::Normal,
typename Scalar =
float>
58 using Ptr = shared_ptr <KFPCSInitialAlignment <PointSource, PointTarget, NormalT, Scalar> >;
59 using ConstPtr = shared_ptr <const KFPCSInitialAlignment <PointSource, PointTarget, NormalT, Scalar> >;
203 const std::vector <int> &base_indices,
204 std::vector <std::vector <int> > &matches,
226 finalCompute (
const std::vector <MatchingCandidates > &candidates)
override;
259 #include <pcl/registration/impl/ia_kfpcs.hpp> float lower_trl_boundary_
Lower boundary for translation costs calculation.
shared_ptr< PointCloud< PointSource > > Ptr
bool initCompute() override
Internal computation initialization.
FPCSInitialAlignment computes corresponding four point congruent sets as described in: "4-points cong...
float lambda_
Weighting factor for translation costs (standard = 0.5).
shared_ptr< Indices > IndicesPtr
void getNBestCandidates(int n, float min_angle3d, float min_translation3d, MatchingCandidates &candidates)
Get the N best unique candidate matches according to their fitness score.
Container for matching candidate consisting of.
void getTBestCandidates(float t, float min_angle3d, float min_translation3d, MatchingCandidates &candidates)
Get all unique candidate matches with fitness scores above a threshold t.
std::vector< MatchingCandidate, Eigen::aligned_allocator< MatchingCandidate > > MatchingCandidates
void setLowerTranslationThreshold(float lower_trl_boundary)
Set the lower translation threshold used for score evaluation.
int validateTransformation(Eigen::Matrix4f &transformation, float &fitness_score) override
Validate the transformation by calculating the score value after transforming the input source cloud...
KFPCSInitialAlignment()
Constructor.
shared_ptr< Registration< PointSource, PointTarget, Scalar > > Ptr
pcl::IndicesPtr indices_validation_
Subset of input indices on which we evaluate candidates.
void finalCompute(const std::vector< MatchingCandidates > &candidates) override
Final computation of best match out of vector of matches.
typename PointCloudSource::Ptr PointCloudSourcePtr
Registration represents the base registration class for general purpose, ICP-like methods...
MatchingCandidates candidates_
Container for resulting vector of registration candidates.
void handleMatches(const std::vector< int > &base_indices, std::vector< std::vector< int > > &matches, MatchingCandidates &candidates) override
Method to handle current candidate matches.
typename VectorType::iterator iterator
bool use_trl_score_
Flag if translation score should be used in validation (internal calculation).
float getUpperTranslationThreshold() const
void setLambda(float lambda)
Set the weighting factor of the translation cost term.
void setUpperTranslationThreshold(float upper_trl_boundary)
Set the upper translation threshold used for score evaluation.
typename PointCloudTarget::Ptr PointCloudTargetPtr
float upper_trl_boundary_
Upper boundary for translation costs calculation.
shared_ptr< const Registration< PointSource, PointTarget, Scalar > > ConstPtr
~KFPCSInitialAlignment()
Destructor.
float getLowerTranslationThreshold() const
KFPCSInitialAlignment computes corresponding four point congruent sets based on keypoints as describe...