基于RANSAC的激光雷达地面点云分割

如何利用RANSAC算法实现激光雷达的地面与非地面点云分割

利用激光雷达做感知输出首先要分割出地面点云以减少对障碍物聚类的影响。本文首先介绍RANSAC的基本原理，并依据RANSAC在ROS中实现对地面点云的分割。接着，引入PCL点云库，PCL点云库中有标准的RANSAC算法接口，我们可以通过调用它实现更加快速，稳定地滤除地面点云。

random sample consensus

ransac是 random sample consensus的缩写，翻译过来是随机抽样一致的意思。它表示可以从一组包含“局外点”的数据集中，通过迭代的方式估计某个数学模型的参数。这是一种包含概率统计思想的“不确定算法”，它的每次迭代并不能保证获得一个正确合理的结果，这是带有概率性的，要想提高获得这种合理结果的概率，就需要增加迭代次数。

ransac的基本假设

1. 整个数据集中同时包含好的点和不好的点，我们将它们分别称为局内点和局外点；
2. 数据的分布可以通过某个数学模型来描述，而局内点就是可以适应该模型的点，局外点是不可以适应该模型的点；
3. 随意给定一组点（可能是局内点也有可能是局外点），我们假设这组点都是局内点，它们满足某个数学模型，我们利用这个数学模型去估算其他的点，如果有足够多的点通过计算能被归类为假设的局内点，那么这个模型就足够合理。

ransac的算法流程

1. 随机在数据集中选取几个点假设为局内点，点的个数选择要依据模型的特征确定，一般来说选择适应于模型的最小数据个数。比如说，要在一堆点中拟合一条直线，那就选取两个点，因为两点确定一条直线；如果要拟合一个平面，那你至少需要选取三个点且不共线。
2. 计算适合这几个点的数学模型；
3. 根据设定的阈值计算数据集中的其他点是否满足该数学模型，如果满足，记为该模型的局内点；
4. 记录下该模型的局内点数量；
5. 重复迭代多次，每次产生的模型要么因为局内点个数太少而被舍弃，要么就比现存模型更好而被选用；
6. 满足迭代退出条件，退出循环，得到整个迭代过程中最合理的解。

如何确定迭代的退出条件？

用W表示随机抽到局内点的概率，用P表示置信度，这个参数表示RANSAC算法在运行后提供有用结果的期望概率。n表示计算模型参数需要选取的数据个数，k表示迭代次数，则

$$W^n表示随机抽取的n个点都是局内点的概率$$
$$1-W^n表示至少存在一个局外点的概率$$
$$(1-W^n{)}^k表示迭代k次都至少存在一个局外点的概率$$
$$当k足够大时，这个概率会变得很小，意味着模型可信度越高$$
那 么 迭 代 k 次 至 少 可 以 获 得 一 组 正 确 模 型 参 数 的 概 率