43 #include <pcl/registration/correspondence_rejection_poly.h>
44 #include <pcl/registration/registration.h>
45 #include <pcl/registration/transformation_estimation_svd.h>
46 #include <pcl/registration/transformation_validation.h>
74 template <
typename Po
intSource,
typename Po
intTarget,
typename FeatureT>
108 shared_ptr<SampleConsensusPrerejective<PointSource, PointTarget, FeatureT>>;
110 shared_ptr<const SampleConsensusPrerejective<PointSource, PointTarget, FeatureT>>;
127 reg_name_ =
"SampleConsensusPrerejective";
253 return (static_cast<int>(n * (rand() / (RAND_MAX + 1.0))));
276 std::vector<pcl::Indices>& similar_features,
285 const Eigen::Matrix4f& guess)
override;
326 #include <pcl/registration/impl/sample_consensus_prerejective.hpp>
KdTreeFLANN is a generic type of 3D spatial locator using kD-tree structures.
typename Registration< PointSource, PointTarget >::PointCloudTarget PointCloudTarget
float getInlierFraction() const
Get the required inlier fraction.
int nr_samples_
The number of samples to use during each iteration.
int getCorrespondenceRandomness() const
Get the number of neighbors used when selecting a random feature correspondence, as set by the user...
int getNumberOfSamples() const
Get the number of samples to use during each iteration, as set by the user.
shared_ptr< PointCloud< FeatureT > > Ptr
void findSimilarFeatures(const pcl::Indices &sample_indices, std::vector< pcl::Indices > &similar_features, pcl::Indices &corresponding_indices)
For each of the sample points, find a list of points in the target cloud whose features are similar t...
shared_ptr< CorrespondenceRejectorPoly< SourceT, TargetT >> Ptr
shared_ptr< const SampleConsensusPrerejective< PointSource, PointTarget, FeatureT >> ConstPtr
TransformationEstimationPtr transformation_estimation_
A TransformationEstimation object, used to calculate the 4x4 rigid transformation.
FeatureCloudConstPtr input_features_
The source point cloud's feature descriptors.
PointIndices::Ptr PointIndicesPtr
typename Registration< PointSource, PointTarget >::Matrix4 Matrix4
PointIndices::ConstPtr PointIndicesConstPtr
float getSimilarityThreshold() const
Get the similarity threshold between edge lengths of the underlying polygonal correspondence rejector...
float inlier_fraction_
The fraction [0,1] of inlier points required for accepting a transformation.
FeatureKdTreePtr feature_tree_
The KdTree used to compare feature descriptors.
void setInlierFraction(float inlier_fraction)
Set the required inlier fraction (of the input)
int getRandomIndex(int n) const
Choose a random index between 0 and n-1.
typename CorrespondenceRejectorPoly::ConstPtr CorrespondenceRejectorPolyConstPtr
shared_ptr< ::pcl::PointIndices > Ptr
pcl::Indices inliers_
Inlier points of final transformation as indices into source.
Pose estimation and alignment class using a prerejective RANSAC routine.
int max_iterations_
The maximum number of iterations the internal optimization should run for.
const FeatureCloudConstPtr getTargetFeatures() const
Get a pointer to the target point cloud's features.
void computeTransformation(PointCloudSource &output, const Eigen::Matrix4f &guess) override
Rigid transformation computation method.
const FeatureCloudConstPtr getSourceFeatures() const
Get a pointer to the source point cloud's features.
typename PointCloudSource::Ptr PointCloudSourcePtr
~SampleConsensusPrerejective() override=default
Destructor.
typename CorrespondenceRejectorPoly::Ptr CorrespondenceRejectorPolyPtr
typename FeatureCloud::Ptr FeatureCloudPtr
void setCorrespondenceRandomness(int k)
Set the number of neighbors to use when selecting a random feature correspondence.
SampleConsensusPrerejective()
Constructor.
void selectSamples(const PointCloudSource &cloud, int nr_samples, pcl::Indices &sample_indices)
Select nr_samples sample points from cloud while making sure that their pairwise distances are greate...
IndicesAllocator<> Indices
Type used for indices in PCL.
void setTargetFeatures(const FeatureCloudConstPtr &features)
Provide a boost shared pointer to the target point cloud's feature descriptors.
Registration represents the base registration class for general purpose, ICP-like methods...
void setNumberOfSamples(int nr_samples)
Set the number of samples to use during each iteration.
const pcl::Indices & getInliers() const
Get the inlier indices of the source point cloud under the final transformation.
FeatureCloudConstPtr target_features_
The target point cloud's feature descriptors.
CorrespondenceRejectorPoly implements a correspondence rejection method that exploits low-level and p...
int k_correspondences_
The number of neighbors to use when selecting a random feature correspondence.
shared_ptr< const ::pcl::PointIndices > ConstPtr
void getFitness(pcl::Indices &inliers, float &fitness_score)
Obtain the fitness of a transformation The following metrics are calculated, based on final_transform...
shared_ptr< const PointCloud< FeatureT > > ConstPtr
std::string reg_name_
The registration method name.
shared_ptr< SampleConsensusPrerejective< PointSource, PointTarget, FeatureT >> Ptr
typename FeatureCloud::ConstPtr FeatureCloudConstPtr
void setSourceFeatures(const FeatureCloudConstPtr &features)
Provide a boost shared pointer to the source point cloud's feature descriptors.
typename Registration< PointSource, PointTarget >::PointCloudSource PointCloudSource
shared_ptr< const CorrespondenceRejectorPoly< SourceT, TargetT >> ConstPtr
typename PointCloudSource::ConstPtr PointCloudSourceConstPtr
void setSimilarityThreshold(float similarity_threshold)
Set the similarity threshold in [0,1[ between edge lengths of the underlying polygonal correspondence...
typename KdTreeFLANN< FeatureT >::Ptr FeatureKdTreePtr
CorrespondenceRejectorPolyPtr correspondence_rejector_poly_
The polygonal correspondence rejector used for prerejection.