散乱点云的圆柱提取和拟合.pdf

第 卷第 期计算机应用与软件 年 月 散乱点云的圆柱提取和拟合周颖林意（江南大学人工智能与计算机学院江苏 无锡 ）收稿日期：。周颖，硕士生，主研领域：微分几何。林意，副教授。摘要圆柱拟合在工业测量中有广泛的应用。基于传统算法的圆柱拟合的缺点包括缺少对初始点云的预处理、需要进行迭代计算、需要手动调节参数等，提出无迭代的圆柱拟合方法。对初始点云进行去噪和降采样，再利用区域生长方法得到拟合需要的数据。在进行圆柱拟合的过程中，通过旋转和投影变换，将三维问题转换为平面问题，基于最小二乘原理，求得圆柱参数。将该方法与传统方法在圆度方面进行对比，该方法在保持高精度的同时避免了迭代计算带来的局部最小陷阱。关键词圆柱拟合无迭代旋转最小二乘原理圆度中图分类号 文献标志码 ：（，），引言随着激光扫描设备在各个领域的应用，人们可以用较低的成本快速获取物体表面的三维坐标，其中对圆柱点云拟合的应用是工业上比较常见的问题。圆柱拟合在工业上的应用包括特征提取 、对象识别 、自主导航 、几何质量检测 、施工测试 等。目前，研究人员对圆柱拟合做了一系列的研究，解决了工业上的一些难题。常用的圆柱拟合方法归纳起来有：遗传算法 、高斯图法 、坐标转换 、圆度判别法 等。这些方法原理复杂、计算量大。对此，张益泽等 提出了任意初值的圆柱拟合方法，通过对传统的误差方程进行改进，减少了各参数之间的关联，在方程中赋予任意初值，利用附有条件方程的间接平差求解圆柱参数；刘支亮等 在文献 的基础上，提出了自适应调整权阵的稳健加权总体算法，以 倍准差为阈值，剔除粗差，构建稳健的最小二乘拟合算法。迭代计算对初值的要求很高，研究人员对迭代初值做了进一步的改进：等 通过协方差估计点云的法向量，再根据最小二乘法来估计轴线方向向量；申旭等 提出了三点共线法求得直线方向向量，把直线方向向量作为初始值代入误差方程迭代求解。此外，等 利用期望最大化和最大似然估计来寻找高斯混合分布情况下的圆柱参数；提出了一种基于最小化正交平方距离和最小的圆柱拟合方法，即第 期周颖，等：散乱点云的圆柱提取和拟合 最小化点到圆柱的正交距离，并用梯度下降法求解；梁雪等 研究了一种一边拟合一边去噪的方法来获取圆柱参数，先随机选取一定量的点，根据圆柱面的方程拟合圆柱，再选取一个阈值，把每一个点代入方程，计算的结果与阈值相比较，若小于阈值，则为内点，否则为噪声点。以上算法大部分都需要迭代计算，计算量大，计算时间长，然而迭代对初始值的要求很高，容易陷入局部最优陷阱，对计算结果产生影响。在工业测量中，受到场地和仪器的限制，很难采集到规则的没有噪声的点云。由于采集到的点云是杂乱的，不能对初始点云直接进行圆柱拟合，因此，本文先对点云进行预处理，采用统计滤波消除噪声点，然后用体素滤波器进行降采样 ，得到数目较少且没有噪声的点云。接下来通过区域生长算法对点云进行分割，提取分割后的圆柱点云，再进行圆柱面拟合。圆柱面可以看作是一组到定直线的距离为定值的点的集合，这一特征表明了圆柱需要 个参数来唯一确定，这 个参数分别是圆柱中心轴线的方向向量（，）、中心轴线上一点（，），以及圆柱面的半径 ，如图 所示，计算点到直线的距离，列出误差方程，利用奇异值分解求出轴线方向向量，再通过旋转，使得轴线与 轴平行，将点云平行投影到 平面，把三维问题转换为了二维平面问题，再根据最小二乘原理拟合圆求出半径。本文方法理论简单，易于实现，而且避免了迭代计算。图 拟合圆柱示例 点云预处理 统计滤波器统计滤波是基于点到其 个邻域点的距离分布的一种滤波方法，通过移除距离不在标准范围内的点来达到去噪的目的。设一组点云数据为 ，对于点云中的每一点，采用 邻近算法求出 个邻域点，假设 到 个邻域点的欧氏距离为 ，则 到 邻域的平均距离 。统计滤波假设点云中所有的点的平均距离 构成一个高斯分布，那么，根据均值 和方差 就能确定标准范围。（）（）（）设标准差倍数为 ，则标准范围是（，）。当 与 邻域的平均距离 不在标准范围内的时候，则认定 为离群点，反之则为内点。体素降采样密集的点云在进行分割和特征提取的时候会增加计算难度和计算时间，用体素滤波器进行降采样能在减少点云数量的同时不改变点云的几何结构。体素是一个三维空间的小立方体，在进行降采样时，体素内所有的点用它们的重心来近似表示，最后，所有体素的重心组成滤波后的点云。如图 所示，图 （）为创建的体积为 的包围盒，图 （）为降采样后的用体素重心表示的点云。体素边长 的大小控制着采样率，当 过小，采样后的点云仍然密集，效果不明显；当 过大，采样后的点云过于稀疏，导致局部特征丢失。（）（）图 体素降采样示例 圆柱提取点云分割有聚类分割 、区域生长 、方法分割 和语义分割 等，本节采用区域生长算法对点云进行分割从而提取圆柱。区域生成算法的基本思想是将具有相同特征的点加入到同一区域，本文的相同特征是指两个点云的法向量的夹角小于设置的平滑阈值。设一组点云数据为 ，区域生成具体步骤包括种子点的选取、生长准则、终止条件。种子点选取的是曲率值最小的点，即最平滑的点。具体步骤如下：（）对点 用 查找其邻域。是一种带有约束条件的二叉查找树，每一级都在当前维度上划分开所有的节点，每个节点都表示一个超平面。的示例如图 所示。计算机应用与软件 年图 示例（）设 为 的 个邻域点构成的协方差矩阵，则有：（）（）（）式中：，为 的邻近点。假设求得式（）的特征值满足 ，对应的特征向量为 、，则最小特征值 对应的特征向量 即为 的法向量，邻域曲率 为：（）邻域曲率反映了该点的邻域所构成的曲面的弯曲程度，越小表明曲面越平坦越接近平面。计算出每一点的邻域曲率，对 进行排序，选择 最小的点作为种子点。（）在进行区域生长的时候，计算邻域点与种子点的法向量之间的夹角，若夹角小于设置的平滑阈值，则把该邻域点加入到当前区域。（）当所有满足条件的点都被合并到当前区域之后，在没有被合并的点中选择曲率最小的点作为种子点，返回第（）步。终止条件是所有点都被合并。（）点云分割完成之后，直接把圆柱点云提取出来即可。圆柱拟合 直线拟合设圆柱中心轴线所在的直线为 ，的方向向量为（，），对 的方向向量进行归一化处理，得到 。设 上某一点的坐标为（，），则 的标准式方程为：（）把式（）写成参数方程为：（）式中：为参数变量。则 可以表示为：（）式中：（，）；（，）。设点 （，）为任意一点，则点 到直线 距离 可以用 与 在 上的投影 的平方差来表示，如图 所示。图 点到直线的距离令 ，则 可以表示为：（）（）槡 （）槡（）建立目标方程：（）（）式中：为测量点的个数。首先，求初始值。对 求导并令其导数为零：（）（）（）故：（）又有：（）（）因此：（）即证明了 过测量点的重心。把式（）展开用点的坐标表示：（）（）（）（）（）（）（）第 期周颖，等：散乱点云的圆柱提取和拟合 将 （，）作为初值，其中：（）对各测量点去重心：（）式（）变形为：（）（）对各参数求导并令其为 ，变换成矩阵形式为：（）对矩阵进行特征值分解，最大特征值对应的特征向量即为 的方向向量。半径拟合旋转点云使 与 轴平行，再将点云投影到 平面上，如图 所示，将三维问题转换为二维问题，再利用最小二乘原理拟合圆。图 拟合半径首先将点云绕 轴旋转 角度，使 与 平面平行，旋转矩阵为：（）其中：槡 槡（）再将点云绕 轴旋转 角度，使 与 轴平行，旋转矩阵为：（）其中：槡 （）设点云的半径为 ，圆心坐标为（，），根据最小二乘原理写出误差方程：（）（）（）对各参数求导并等于 ，令：，（）变换为矩阵形式为：()（）（）（）（）（）解方程求出圆心坐标（，），代入求导公式中，求出 ，再通过反坐标变换求出在圆柱上的圆心点。实例与分析为验证本方法的有效性，采用三维扫描仪对桌面进行扫描，对得到的数据进行处理，可视化如图 （）所示。按照第 节提到的方法，首先对初始点云点云进行统计滤波去噪，本文选择的邻域点个数是 ，标 计算机应用与软件 年准差倍数是 ，去噪后的点云如图（）所示，数目为 ，可以看出，原始点云中的噪声点基本已去除，靠近圆柱边缘的点还存在小部分，在进行区域生长的时候会剔除掉。为了缩短后续区域分割的时间和提高圆柱拟合的效率，接下来对点云进行降采样，降低点云的密度。设置体素边长为 时，点云数目为 ，如图（）所示，可以很明显地看到点云密度降低了，并且保留了点云的形状特征；设置体素边长为 时，点云数目为 ，如图 （）所示，点云更加稀疏，且形状特征没有发生变化。本文选用边长为 的体素进行降采样。（）原始点云（）去噪后的点云图 点云滤波去噪（）体素边长 （）体素边长 图 不同边长的体素对点云进行降采样在进行区域生长分割时，根据实际情况选择合适的曲率阈值和平滑阈值，本文中设置的平滑阈值为 ，曲率阈值为 ，将点云分割成平面、圆柱和边缘噪声点，再通过设置最小簇类数目将噪声点剔除，分割完成之后，把圆柱点云提取出来，如图 所示。图 提取出来的圆柱点云提取出圆柱点云之后，按照本文方法对圆柱进行拟合，求出的轴线方向向量为（，），拟合半径 ，圆柱的轴线方程可以表示为：（）式中：为参数变量。平面圆的圆度是指点到圆心的距离与半径之差，同理扩展到三维空间，圆柱的圆度 是指圆柱面上的点到中心轴线的距离与半径之差，计算结果如表 所示，图 为圆度折线。对圆度进行统计，圆度均值为 ，标准差为 。表 部分观测点的圆度值点号圆度 点号圆度 点号圆度 图 圆度折线为了进一步验证本文方法的正确性和有效性，采用文献 中的算法和数据进行圆柱拟合，本文算法中的（，）与文献 中的（，）都表示轴线上一点，但是意义不同，所以没有可比较性，只需要比较另外四个参数值即可。表 是本文方法与文献 和文献 中方法的比较，图 是三种方法的圆度比较，可以看出，三种方法的差异是比较小的，且本文方法的圆度标准差略小，说明了本文方法的正确性。表 与文献 和文献 结果对比参数本文方法文献 文献 第 期周颖，等：散乱点云的圆柱提取和拟合 续表 参数本文方法文献 文献 均值 标准差 图 圆度对比 结语本文介绍了从散乱点云中提取圆柱点云并进行圆柱拟合的一种方法。本文方法首先用统计滤波器和体素滤波器对点云进行预处理，然后采用区域生长算法对点云进行分割，得到拟合算法需要的数据，然后利用点到直线的距离建立方程，求出轴线，然后通过旋转和投影，将三维问题转换为二维平面问题，最后利用最小二乘法拟合出半径。本文方法原理简单，便于实现，而且具有很好的精度，最大的特点是避免了迭代。通过实验分析和比较，证明了本文方法的有效性和正确性。在用滤波统计器进行去噪的时候，邻域点的个数和标准差倍数的选取对结果是有直接影响的，这里值得进一步研究。参考文献 ，（）：，：，（）：，：谯珊，刘钰，任同群，等 城市管道现场组对施工控制 机电工程技术，（）：，秦世伟，潘国荣，谷川，等 基于遗传算法的三维空间柱面拟合 同济大学学报（自然科学版），（）：，（）：田晓，李全海 基于坐标转换的三维空间圆柱面拟合 工程勘察，（）：鲍金，王解先 改进的投影圆度判别法圆柱拟合 矿山测量，（）：张益泽，王解先 初值任意选取的圆柱面拟合方法 工程勘察，（）：刘支亮，李明峰，陆建华 基于稳健加权总体最小二乘的点云数据圆柱面拟合 现代测绘，（）：，（）：申旭，朱文芳，王伟峰，等 一种空间圆柱面拟合计算方法 测绘科学技术学报，（）：，（）：，（）：梁雪，黄祖广，张承瑞，等 基于机器视觉的散乱柱类零件抓取系统 制造技术与机床，（）：张彬，熊传兵 基于体素下采样和关键点提取的点云自动配准 激光与光电子学进展，（）：，：，：陆桂亮 三维点云场景语义分割建模研究 南京：南京大学，李新春，闫振宇，林森，等 基于邻域特征点提取和匹配的点云配准 光子学报，（）：