一种三维点云道路边界自动提取方法与流程
本发明涉及点云处理领域，尤其是涉及一种三维点云道路边界自动提取方法。
背景技术：
道路作为交通基础设施，其数字化的管理与建设对于城市规划、交通管理以及导航等应用具有重要的意义。车载激光扫描技术作为一项发展迅速的高新测绘技术，相比于传统测绘手段，具有数据获取速度快、数据精度高、非接触主动测量、实时性强等优势，在车辆正常行进过程中能快速获取道路及两侧地物详尽的三维空间信息，对于带状分布的道路信息获取具有明显优势。
传统获取道路信息的方法主要包括人工测量和数字摄影测量两张方式。人工测量虽然能够获得较为准确的道路坐标等信息，但是测量速度较慢，道路信息更新周期较长；数字摄影测量随着科学技术的发展和计算机等高新技术的广泛应用逐渐发展和成熟起来，但是受限于影像分辨率等原因，影像中提取的道路特征信息和精度要求仍然需要进一步提高。车载激光扫描系统由全球定位系统、惯性导航系统、激光扫描仪和CCD相机等组成，成为获取三维空间数据的新手段。使用车载激光扫描技术能够有效地节省测量时间，提高测量效率，缩短道路信息更新周期，避免了交通环境下测量作业人员暴露的危险性，为城市空间资源的勘测与规划提供有力的技术保障。
然而，城市通常环境复杂，不仅附属部件复杂繁多，且被扫描目标之间相互遮挡造成数据缺失，对道路边界自动提取带来考验。此外，不同道路环境引起的复杂性(比如车辆停靠，植被环绕，栅栏等)加大了道路边界的自动提取难度。因此，从海量点云中快速、自动地提取道路边界难度大，要求高，但该技术具有重要的经济和应用需求，一直是国内外的研究热点。
目前，车载激光扫描数据处理方面的研究大多集中在地物点云分类、建筑物立面信息提取与建模、道路附属设施提取等方面，而对道路边界信息提取的研究相对较少，主要工作可以分为间接提取和直接提取两类。
间接提取的方法一般是首先使用点云的属性(高度、强度及波长等)产生深度图像，然后使用图像处理的方法(裁切、拟合以及滤波等)来检测、提取道路边界。对于间接提取的方法，即将点云转换成深度图像，然后使用图像处理的方法提取道路边界，这些方法势必会在转换过程中产生误差，很难获取准确的道路边界结果。
直接提取的方法一般是使用道路特征(比如平面、路牙子等)来检测、提取道路边界。常用的方法为用基于随机抽样一致(RANSAC)的方法提取道路面，然后用线性拟合的算法来得到道路边界。用高斯滤波的方法或者滑动窗口的方法来检测路牙子，由此获得道路边界。对于直接提取的方法而言，则对场景的应用范围有较大局限。使用基于随机抽样一致(RANSAC)的方法提取道路面，在面对道路起伏的情况时会有困难，往往提取的道路面也会损失一些细节。而使用高斯滤波的方法或者滑动窗口的方法来检测路牙子的方法，往往在面对不规则道路边界(比如墙，栅栏)或者植被环绕的情况时会有挑战。
技术实现要素：
本发明的目的在于克服上述现有技术的不足，本发明提供一种三维点云道路边界自动提取方法，该方法可以直接运行在大规模三维点云上，可用于不同场景，计算速度快，算法鲁棒性好，可快速提取道路边界。
具体技术方案如下：
一种三维点云道路边界自动提取方法，包括以下步骤：
S1、对获得的整个三维点云数据集P，筛选种子点进行超体素划分；
S2、使用α-shape算法提取邻近非共面的超体素之间的边界点；
S3、使用基于图割的能量最小化算法提取道路边界点；
S4、基于欧几里得距离聚类算法去除离群点；
S5、将提取的道路边界点拟合成平滑曲线。
优选地，步骤S1对超体素的划分过程，具体如下:
S11、求解拟合平面Tp(pi)：
对于整个三维点云数据集P的每个输入点pi，其切平面Tp(pi)可以表示为由其中心点oi和法向量nl组成的二元组，即
三维空间内的任一点p到Tp(pi)的距离可以表示为
记pi的K近邻构成的集合为Nbk(pi),通过求解下式可以得到最小二乘意义下的最佳拟合平面
然后采用迭代重加权的最小二乘法来优化拟合的平面
解带权最小二乘方程即可得到优化后的拟合平面Tp(pi)
对平面Tp(pi)重复上述过程，直到算法收敛。
S12、去除非地面点：
记最终构成切平面Tp(pi)的点集的协方差矩阵的三个特征值为λ1,λ2,和λ3，且满足λ1≥λ2≥λ3。则点pi的平滑度s(pi)可以表示为
使用下面两个限制来去除非地面点：
A、去除明显高于路面的点(zi≥5m)(zi为点pi的高度值)；
B、去除其法向量与Z轴夹角大于22.5°的点。
S13、计算超体素fi：
将去除非地面点以后的点集Pg按照每个点的平滑度排序，首先选择平滑度大的点作为种子点。从种子点开始进行区域增长的方式来计算超体素。将超体素fi形式化的定义为一个有所属点集Pi，中心点oi，和法向量nl所构成的三元组对每个种子点seedi，令其初始的超体素fi的初始点集为{pi}，中心点和法向量分别是Tp(pi).oi和Tp(pi).nl。然后，采用宽度优先的原则对fi进行区域增长。对每个候选点pj，如果满足(1)pj到pi的距离小于阈值Rseed；(2)向量Tp(pj).nl与Tp(pi).nl的夹角小于22.5°；(3)pj到Tp(pi)的距离小于阈值∈；则将pj加入到fi的点集中。当fi无法再扩展时，根据fi.pi使用最小二乘法拟合平面，并将fi.nlg更新为拟合平面的法向量。在这些初始小平面的基础上采用局部K均值聚类来将点赋值于超体素，并保证每个点到其所属的超体素的距离小于到其他超体素的距离。这里的距离函数定义为：
其中Ds,Dn和Di分别是欧几里得距离，法向量距离以及强度距离。ωs,ωn和ωi分别是对应的权值。
优选地，步骤S2使用α-shape算法提取邻近非共面的超体素之间的边界点的具体步骤为：
将点云分割成超体素以后，对于每个超体素，可以使用α-shape算法来提取边界点，同时，去除两个彼此共面的超体素之间的边界点，即如果两个超体素的法向量夹角小于22.5°,则删除这两个超体素之间的边界点，此时的边界点Pb包括道路边界点和非道路边界点。
优选地，步骤S3使用基于图割的能量最小化算法提取道路边界点，具体如下：
由车载激光扫描系统提供车辆行驶轨迹线数据，将轨迹线数据作为图割算法的初始观测模型。能量公式定义为：
E(f)＝Edata(f)+λ·Esmooth(f)
这里Pb是指步骤2中提取到的边界点的集合。n是pi所属超体素的点集的势。Δdj是指点pj到直线Lpi的距离。Δdi是指点pi邻域内所有点到直线Lpi的平均冗余。σ1是指所有点的平均冗余。直线Lpi定义为经过点pi且方向与距离pi最近的轨迹线的方向。
(xi,yi,zi),(xj,yj,zj)分别是点pi和pj的三维坐标，是指点pi和pj的欧式距离。这里表示的是如果点pi和pj分配的标签一致的话，代价为零，反之代价为
这里σ2指的是点集Pb的空间分辨率。使用图割算法求得上述能量公式最小值的结果即将边界点分为两类，一类是道路边界点，另一类是非道路边界点。
本发明的方案与现有技术相比，具有如下优点：
(1)本发明可以直接运行在大规模三维点云上，为道路边界的提取与定位提供一套快速有效地自动化解决方案。需要人为设置的参数非常少，减少了人为主观干预。与现有技术相比，本发明采用超体素分割和基于图割的最小化能量算法，在复杂的城市环境情况下依然可以有效提取道路边界，由于结合使用了车载系统轨迹线数据进行计算，克服了点云数据遮挡，密度分布不均等缺点，使得结果稳定鲁棒，对不同场景都具有普适性，易于实际运用。
(2)本发明充分挖掘了点云的基础属性(空间距离，几何性质以及强度信息)，将点云进行超体素分割，同时去除非地面点，提高了后续的计算效率。由于将种子点进行排序，优先选择的方法，超体素分割的结果非常好得保存了边界信息，提高了后续提取道路边界算法的鲁棒性。
(3)本发明在模型算法上进行了创新优化，首次提出基于图割的能量最小化算法，利用车载系统提供的轨迹线数据，结合道路边界的内在特征来建立图割模型，有效快速地提取到道路边界。
附图说明
图1本发明技术方案的的流程示意图；
图2本发明实施例原始点云数据；
图3处理后的效果图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
实施例
本发明提出的基于车载激光扫描点云数据进行道路边界提取方法的具体实施方案如下(总的技术方案流程可见图1)：
S1、对获得的整个三维点云数据集P，筛选种子点进行超体素划分(本实施例的原始点云数据可见图2)；
超体素划分是指将邻近的性质一致的点聚拢为一个超级点，以此来减少数据处理的复杂度；
S11、求解拟合平面Tp(pi)：
对于整个三维点云数据集P的每个输入点pi，其切平面Tp(pi)可以表示为由其中心点oi和法向量nl组成的二元组，即
三维空间内的任一点p到Tp(pi)的距离可以表示为
记pi的K近邻构成的集合为Nbk(pi),通过求解下式可以得到最小二乘意义下的最佳拟合平面
然后采用迭代重加权的最小二乘法来优化拟合的平面
解带权最小二乘方程即可得到优化后的拟合平面Tp(pi)
对平面Tp(pi)重复上述过程，直到算法收敛。
S12、去除非地面点：
记最终构成切平面Tp(pi)的点集的协方差矩阵的三个特征值为λ1,λ2,和λ3，且满足λ1≥λ2≥λ3。则点pi的平滑度s(pi)可以表示为
使用下面两个限制来去除非地面点：
A、去除明显高于路面的点(zi≥5m)(zi为点pi的高度值)；
B、去除其法向量与Z轴夹角大于22.5°的点。
S13、计算超体素fi：
由此，将去除非地面点以后的点集Pg按照每个点的平滑度排序，首先选择平滑度大的点作为种子点。从种子点开始进行区域增长的方式来计算超体素。将超体素fi形式化的定义为一个有所属点集Pi，中心点oi，和法向量nl所构成的三元组对每个种子点seedi，令其初始的超体素fi的初始点集为{pi}，中心点和法向量分别是Tp(pi).oi和Tp(pi).nl。然后，采用宽度优先的原则对fi进行区域增长。对每个候选点pj，如果满足(1)pj到pi的距离小于阈值Rseed；(2)向量Tp(pj).nl与Tp(pi).nl的夹角小于22.5°；(3)pj到Tp(pi)的距离小于阈值∈；则将pj加入到fi的点集中。当fi无法再扩展时，根据fi.pi使用最小二乘法拟合平面，并将fi.nlg更新为拟合平面的法向量。在这些初始小平面的基础上采用局部K均值聚类来将点赋值于超体素，并保证每个点到其所属的超体素的距离小于到其他超体素的距离。这里的距离函数定义为：
其中Ds,Dn和Di分别是欧几里得距离，法向量距离以及强度距离。ωs,ωn和ωi分别是对应的权值。
S2、使用α-shape算法提取邻近非共面的超体素之间的边界点；
将点云分割成超体素以后，对于每个超体素，可以使用α-shape算法来提取边界点。同时，去除两个彼此共面的超体素之间的边界点，即如果两个超体素的法向量夹角小于22.5°,则删除这两个超体素之间的边界点。此时的边界点Pb包括道路边界点和非道路边界点。
α-shape算法可以看作是闭包Convex Hull的扩展，它可以通过调整α参数计算更精细的闭包从而大致描述平面或空间上一群点的外形，具体是用某个固定半径的圆去套一对一对的点，当一对点都刚好落在圆上而且圆内不包含任何其他点的时候，这两个点就是形状的边界点。通过这样的方法找出所有的边界点，便描述出了Alpha shape。
S3、使用基于图割的能量最小化算法提取道路边界点；
接下来使用基于图割的能量最小化算法来提取道路边界点。车载激光扫描系统提供车辆行驶轨迹线数据，观察到轨迹线数据与测量道路位置方向保持基本一致。由此将轨迹线数据作为图割算法的初始观测模型。能量公式定义为：
E(f)＝Edata(f)+λ·Esmooth(f)
这里Pb是指步骤2中提取到的边界点的集合。n是pi所属超体素的点集的势。Δdj是指点pj到直线的距离。Δdi是指点pi邻域内所有点到直线的平均冗余。σ1是指所有点的平均冗余。直线定义为经过点pi且方向与距离pi最近的轨迹线的方向。
(xi,yi,zi),(xj,yj,zj)分别是点pi和pj的三维坐标，是指点pi和pj的欧式距离。这里表示的是如果点pi和pj分配的标签一致的话，代价为零，反之代价为
这里σ2指的是点集Pb的空间分辨率。使用图割算法求得上述能量公式最小值的结果即将边界点分为两类，一类是道路边界点，另一类是非道路边界点。
S4、基于欧几里得距离聚类算法去除离群点；
使用欧几里得距离聚类算法将上述获得的道路边界点进行聚类，并删除点数很小的类别，即聚类以后，如果一个类别包含的点的个数小于5，则删除这个类别。
S5、将提取的道路边界点拟合成平滑曲线。
将剩下的类分别拟合成光滑的曲线，由此就得到了道路边界。这里使用三次样条插值(Cubic Spline Interpolation)来拟合直线。
其中，图3为处理后的效果图，表示提取的道路。
以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应该以权利要求的保护范围为准。
- 还没有人留言评论。精彩留言会获得点赞！