天天看点

PCL采样一致性算法

在计算机视觉领域广泛的使用各种不同的采样一致性参数估计算法用于排除错误的样本,样本不同对应的应用不同,例如剔除错误的配准点对,分割出处在模型上的点集,PCL中以随机采样一致性算法(RANSAC)为核心,同时实现了五种类似与随机采样一致形算法的随机参数估计算法,例如随机采样一致性算法(RANSAC)最大似然一致性算法(MLESAC),最小中值方差一致性算法(LMEDS)等,所有估计参数算法都符合一致性原则。在PCL中设计的采样一致性算法的应用主要就是对点云进行分割,根据设定的不同的几个模型,估计对应的几何参数模型的参数,在一定容许的范围内分割出在模型上的点云。

(1)RANSAC随机采样一致性算法的介绍

RANSAC是“RANdom SAmple Consensus(随机抽样一致)”的缩写。它可以从一组包含“局外点”的观测数据集中,通过迭代方式估计数学模型的参数。它是一种不确定的算法——它有一定的概率得出一个合理的结果;为了提高概率必须提高迭代次数。

数 据分两种:有效数据(inliers)和无效数据(outliers)。偏差不大的数据称为有效数据,偏差大的数据是无效数据。如果有效数据占大多数,无 效数据只是少量时,我们可以通过最小二乘法或类似的方法来确定模型的参数和误差;如果无效数据很多(比如超过了50%的数据都是无效数据),最小二乘法就 失效了,我们需要新的算法

一个简单的例子是从一组观测数据中找出合适的2维直线。假设观测数据中包含局内点和局外点,其中局内点近似的被直线所通过,而局外点远离于直线。简单的最 小二乘法不能找到适应于局内点的直线,原因是最小二乘法尽量去适应包括局外点在内的所有点。相反,RANSAC能得出一个仅仅用局内点计算出模型,并且概 率还足够高。但是,RANSAC并不能保证结果一定正确,为了保证算法有足够高的合理概率,我们必须小心的选择算法的参数。

PCL采样一致性算法
PCL采样一致性算法

                                   左图:包含很多局外点的数据集                                           右图:RANSAC找到的直线(局外点并不影响结果)

概述

    RANSAC算法的输入是一组观测数据,一个可以解释或者适应于观测数据的参数化模型,一些可信的参数。

    RANSAC通过反复选择数据中的一组随机子集来达成目标。被选取的子集被假设为局内点,并用下述方法进行验证:

    1.有一个模型适应于假设的局内点,即所有的未知参数都能从假设的局内点计算得出。

    3.如果有足够多的点被归类为假设的局内点,那么估计的模型就足够合理。

    4.然后,用所有假设的局内点去重新估计模型,因为它仅仅被初始的假设局内点估计过。

    5.最后,通过估计局内点与模型的错误率来评估模型。

算法

    伪码形式的算法如下所示:

输入:

data —— 一组观测数据

model —— 适应于数据的模型

n —— 适用于模型的最少数据个数

k —— 算法的迭代次数

t —— 用于决定数据是否适应于模型的阀值

d —— 判定模型是否适用于数据集的数据数目

输出:

best_model —— 跟数据最匹配的模型参数(如果没有找到好的模型,返回null)

best_consensus_set —— 估计出模型的数据点

best_error —— 跟数据相关的估计出的模型错误

iterations = 0

best_model = null

best_consensus_set = null

best_error = 无穷大

while ( iterations < k )

    maybe_inliers = 从数据集中随机选择n个点

    maybe_model = 适合于maybe_inliers的模型参数

    consensus_set = maybe_inliers

    for ( 每个数据集中不属于maybe_inliers的点 )

        if ( 如果点适合于maybe_model,且错误小于t )

            将点添加到consensus_set

    if ( consensus_set中的元素数目大于d )

        已经找到了好的模型,现在测试该模型到底有多好

        better_model = 适合于consensus_set中所有点的模型参数

        this_error = better_model究竟如何适合这些点的度量

        if ( this_error < best_error )

            我们发现了比以前好的模型,保存该模型直到更好的模型出现

            best_model =  better_model

            best_consensus_set = consensus_set

            best_error =  this_error

    增加迭代次数

返回 best_model, best_consensus_set, best_error

(2)最小中值法(LMedS)

LMedS的做法很简单,就是从样本中随机抽出N个样本子集,使用最大似然(通常是最小二乘)对每个子集计算模型参数和该模型的偏差,记录该模型参 数及子集中所有样本中偏差居中的那个样本的偏差(即Med偏差),最后选取N个样本子集中Med偏差最小的所对应的模型参数作为我们要估计的模型参数。

在PCL中sample_consensus模块支持的几何模型

SACMODEL_TORUS - not implemented yet

SACMODEL_PARALLEL_LINES - not implemented yet

(2)PCL中Sample_consensus模块及类的介绍

PCL中Sample_consensus库实现了随机采样一致性及其泛化估计算法,例如平面,柱面,等各种常见的几何模型,用不同的估计算法和不同的几何模型自由的结合估算点云中隐含的具体几何模型的系数,实现对点云中所处的几何模型的分割,线,平面,柱面 ,和球面都可以在PCL 库中实现,平面模型经常被用到常见的室内平面的分割提取中, 比如墙,地板,桌面,其他模型常应用到根据几何结构检测识别和分割物体中,一共可以分为两类:一类是针对采样一致性及其泛化函数的实现,一类是几个不同模型的具体实现,例如:平面,直线,圆球等

pcl::SampleConsensusModel< PointT >是随机采样一致性估计算法中不同模型实现的基类,所有的采样一致性估计模型都继承与此类,定义了采样一致性模型的相关的一般接口,具体实现由子类完成,其继承关系:

PCL采样一致性算法

类成员的介绍

SampleConsensusModel类的构造函数,cloud为输入点云对象的指针,indices为算法使用点云索引向量,如果设置random=true则用当前时间初始化随机化函数的种子否则使用12345作为种子

virtual void 

获取一组随机采样点数据以点云中点的索引方式存储到samples,iterations为迭代次数

virtual bool 

纯虚函数检查给定的点云索引样本samples能否一个有效的模型,

优化初始估计的模型参数,inliers设定的局内点,model_coefficients初始估计的模型的系数,optimized_coefficients优化后的模型系数

计算点云中所有点到给定模型中model_coefficients的距离,存储到distances

从点云中选择所有到给定模型model_coefficients的距离小于给定的阀值 threshold 的点为局内点,inliers存储最终输出的局内点

virtual int 

统计点云到给定模型model_coefficients距离小于阀值的点的个数

将局内点inliner投影到model_coefficients上创建一组新的点云projected_points,

        (太多了  太耽误时间了)**************************

(2)pcl::SampleConsensus< T > 是采样一致性算法的基类

其中model设置随机采样性算法使用的模型,threshold 阀值 

void 

Set the Sample Consensus model to use.

Set the distance to model threshold.

double 

Get the distance to model threshold, as set by the user.

Set the maximum number of iterations.

int 

Get the maximum number of iterations, as set by the user.

Set the desired probability of choosing at least one sample free from outliers.

Obtain the probability of choosing at least one sample free from outliers, as set by the user.

Compute the actual model.

Refine the model found.

Get a set of randomly selected indices.

(3)pcl::RandomizedMEstimatorSampleConsensus< PointT > 实现了RANSAC算法,RANSAC算法适用与处理数据点中局内点比例比较大的情况,科快速的进行局外点的剔除。

class  pcl::SampleConsensusModelCircle2D< PointT >实现采样一致性 计算二位平面圆周模型

class  pcl::SampleConsensusModelCone< PointT, PointNT >  实现采样一致性计算的三维椎体模型

太多了

class  

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_least_median_squares.html">pcl::LeastMedianSquares&lt; PointT &gt;</a>

LeastMedianSquares represents an implementation of the LMedS (Least Median of Squares) algorithm.

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_maximum_likelihood_sample_consensus.html">pcl::MaximumLikelihoodSampleConsensus&lt; PointT &gt;</a>

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_m_estimator_sample_consensus.html">pcl::MEstimatorSampleConsensus&lt; PointT &gt;</a>

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_progressive_sample_consensus.html">pcl::ProgressiveSampleConsensus&lt; PointT &gt;</a>

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_random_sample_consensus.html">pcl::RandomSampleConsensus&lt; PointT &gt;</a>

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_randomized_m_estimator_sample_consensus.html">pcl::RandomizedMEstimatorSampleConsensus&lt; PointT &gt;</a>

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_randomized_random_sample_consensus.html">pcl::RandomizedRandomSampleConsensus&lt; PointT &gt;</a>

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_sample_consensus_model_normal_parallel_plane.html">pcl::SampleConsensusModelNormalParallelPlane&lt; PointT, PointNT &gt;</a>

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_sample_consensus_model_normal_sphere.html">pcl::SampleConsensusModelNormalSphere&lt; PointT, PointNT &gt;</a>

<a href="http://docs.pointclouds.org/trunk/classpcl_1_1_sample_consensus_model_parallel_line.html">pcl::SampleConsensusModelParallelLine&lt; PointT &gt;</a>

代码实例 random_sample_consensus.cpp

运行结果:

在没有任何参数的情况下,三维窗口显示创建的原始点云(含有局内点和局外点),如图所示,很明显这是一个带有噪声的菱形平面,噪声点是立方体,自己要是我们在产生点云是生成的是随机数生在(0,1)范围内。

./random_sample_consensus

PCL采样一致性算法

./random_sample_consensus -f

PCL采样一致性算法

./random_sample_consensus -sf

PCL采样一致性算法

 未完待续****************************************************8

继续阅读