1
收稿日期：2020-07-27
作者简介：曾祥（1989—），男，博士，工程师，主要从事环境感知技术研究。
曾 祥，蒋国涛，鲍纪宇，刘邦繁，肖志鸿
（中车株洲电力机车研究所有限公司，湖南 株洲 412001）
摘 要：采用激光雷达对隧道环境中的障碍物进行检测时，海量的隧道点云容易造成虚警。对此，文章提出了一种基于车载激光雷达的隧道内障碍物检测方法。其首先设计了背景点云的滤除策略，根据三维 点云生成二维栅格图，并标记隧道边界栅格和地面栅格；对隧道边界栅格点云进行欧几里得聚类和边界曲线估计，根据估计曲线滤除隧道边界点云；对地面栅格点云进行平面估计，根据估计平面滤除地面点云。接着，对保留的障碍物点云进行欧几里得聚类并提取障碍物的尺寸和位置信息。最后，应用改进距离准则的全局最近邻算法和卡尔曼滤波算法对障碍物进行跟踪，并设计了基于生命状态转移的目标航迹管理策略。实验结果表明，本文所提方法不仅能有效消除背景点云的干扰，而且能稳定识别和跟踪隧道内的障碍物。 关键词：环境感知；激光雷达；障碍物识别；点云；隧道；参数估计；距离准则；生命状态转移中图分类号 ：U1；TP24 文献标识码 ：A 文章编号 ：2096-5427(2021)01-0001-08doi:10.13889/j.issn.2096-5427.2021.01.100
Detection of Obstacles in Tunnel Based on Vehicle-borne LiDAR
ZENG Xiang, JIANG Guotao, BAO Jiyu, LIU Bangfan, XIAO Zhihong
( CRRC Zhuzhou Institute Co., Ltd., Zhuzhou, Hunan 412001, China )
Abstract: Massive point clouds introduced by tunnel wall reflection can easily cause false alarms in LiDAR-based detection of obstacles in tunnel environment. A vehicle-borne LiDAR based obstacle-in-
tunnel detection methodology is proposed in this paper. Firstly, a strategy of removing background point cloud is designed. 2D grid map is generated from 3D point cloud, and grids corresponding to the tunnel boundary or the ground are labeled respectively. Based on the Euclidean clustering algorithm, the point cloud corresponding to the tunnel boundary is extracted. With the estimation of the parameters of the boundary curves, point cloud corresponding to the tunnel boundary is further removed. Similarily, the point cloud corresponding to the ground is also removed based on the estimation of parameters of a space plane. Subsequently, the obstacles are extracted independently from the remaining point cloud by Euclidean clustering, followed by the estimation of the position and dimensions of all those obstacles. Finally, the obstacles tracking is achieved by means of the global nearest neighbor algorithm with improved distance metric and the Kalman filter, and the track of all obstacles is updated by a customized life state transition strategy. Experimental results show that the proposed method can eliminate the interference of background point cloud effectively and yield stable results of obstacles identification and tracking.
Keywords: environment perception; LiDAR; obstacles identification; point cloud; tunnel; parameter estimation; distance metric; life state transition
总第469期2021年第1
期
0 引言
激光雷达因具有高测距精度、高分辨率、受光
照影响小的优点而被广泛应用于车辆环境感知领域。Premebida Cristiano ，Ludwig Oswaldo 等
[1]
对激光点
云进行特征提取和分类，实现了对城市场景中行人的识别。Zhang Wende [2]
使用激光雷达对道路和道路边缘进行了检测。Muresan Mircea Paul ，Nedevschi
22021年第1期
Sergiu 等
[3]
针对高线数激光雷达存在的价格昂贵的
不足，提出了一种基于4线激光雷达的实时目标检测算法。Granström Karl ，Renter Stephan 等[4]
提出了一种随机优化方法，以直接处理多目标跟踪中的
数据关联问题。Sahba Ramin ，Sahba Amin 等[5]
使用
PointPillars 网络对汽车、行人进行了识别。Szarvas M.，
Sakai U.等
[6]
采用卷积神经网络实现了激光点云中对
行人的高效检测。黄如林、梁华为等[7]
提出了基于
多特征融合的动态障碍物检测跟踪方法和基于时空特征向量的动态障碍物识别方法，提高了激光雷达对动态障碍物的识别和跟踪准确率。宗长富、文龙等
[8]
提出了一种新颖的点云去畸变方法和一种基于距离分区的欧氏聚类算法，在一定程度上解决了欧氏聚类算法在点云分布不均及存在畸变时的障碍物检测成功率低的问题。胡云卿、冯江华等
[9]
利用激光雷达、
毫米波雷达和360度环视系统构建了智轨电车的环境感知系统。然而，目前基于激光雷达的障碍物检测多在开放环境中进行，针对隧道内障碍物检测的研究尚不多见。近年来，随着山区公路交通建设和城市轨道交通建设的快速发展，隧道里程增长迅速，应用激光雷达对隧道内的障碍物进行检测，有助于提高车辆在隧道内运行的安全性。
本文对基于车载激光雷达的隧道内的障碍物检测问题进行了研究。在滤除隧道壁点云和地面点云的基础上，对点云进行聚类以识别障碍物；采用改进的距离准则进行数据关联，结合卡尔曼滤波实现障碍物的运动状态更新，并设计了生命状态转移机制以实现障碍物的航迹管理。
1 基础算法原理
本文对点云的处理主要涉及随机采样一致性（random sample consensus ，RANSAC ）方法[10]
和欧
几里得聚类方法。1.1 RANSAC 模型拟合
基于待拟合的模型（如直线），可由N 个空间点P i (x i , y i , z i )(其中i =1, 2, …, N )构成的点集P 建立超定方程组Pv =q ，其中矩阵P 和向量q 由点集P 确定，v 为待估计的参数向量。通常，v 的估计通过最小二乘法进行。当P 中存在异常数据时，若直接采用最小二乘法求解v ，可能会产生较大偏差。
RANSAC 算法在求解v 时充分考虑了异常数据的影响。设P 中局内点的占比为ε，重复地从P 中随机抽取m 个点构成子集。若某子集中不含有异常
点，则该子集为良性子集。记至少取得一个良性子集的概率为p *
，其与相应的最小迭代次数N min 满足
如下关系：
(1)
设定任意点是否归属于拟合模型的阈值T ε，并记集合P ~
为每次迭代结束后点集P 中归属于拟合模
型的点构成的子集。记M 为集合P ~
的元素个数，K 为待估计参数的个数，即向量v 的维数。基于RANSAC 的模型拟合步骤如下：
（1）初始化，使。
（2）从P 中随机选择K 个不共线的点P i (x i , y i ,
z i )，其中i =1, 2, …, K 。
（3）产生估计假设。由选择的K 个点坐标计算参数向量v 。为避免混淆，记此时的参数向量为v 0。
（4）假设验证和优选。计算由v 0引起的偏差向量e =Pv 0-q 。引入计数m 并初始化，使m =0。依次遍历e 中的所有元素，若第j 个元素e ( j )满足|e ( j )|≤T ε，则计数m 增1。比较m 和M 的大小。若m >M ，则代表当前估计的参数向量v 0较上次的结果更优，此时，
先清空P ~
，再将所有满足|e ( j )|≤T ε的点P j 加入集合P ~
中；反之，若m ≤M ，则放弃当前估计。
（5）重复步骤（2）~（4），直到迭代次数达到N min 。
（6）优化估计。将P ~
中的点集代入到方程组Pv =q ，采用最小二乘法再次求解v ，见式(2)。
v =(P T
P )-1
P T q (2)
1.2 欧几里得聚类
对于具有明显邻域关系的元素的聚类问题，采用基于距离准则的近邻聚类方法通常能取得不错的效果。本文采用的是成熟的欧几里得聚类算法，同时采用维树（k-dimensional tree ，kd 树）以加快对邻域元素的搜索。算法流程如下：
（1）对输入数据P 建立kd 树，创建一个空的聚类列表C 和待处理元素队列Q ，设定元素的邻域半径δ。
（2）对P 中每一个未处理的元素P i ，将P i 加入Q 中。
（3）对Q 中每一个点，在P 中搜索其δ邻域内的一组近邻点；对任一近邻点，若其未被处理过，则将该点加入Q 。重复该步骤，直到Q 中所有点都被处理完毕，则将Q 中的点加入C 中，并清空Q 。
（4）检查P 中的所有点是否均已被处理且加入C 中。若是，则算法结束；反之，则返回到步骤（2）。
3
曾祥 等：基于车载激光雷达的隧道内障碍物检测
2021年第1期
2 障碍物检测算法
激光雷达在隧道内扫描时，点云的主要来源包括隧道壁、地面和可能存在的障碍物。图1示出隧道内的激光点云数据，可以看出，在接收点云中，隧道壁点云和地面点云的占比非常高。对于障碍物检测而言，海量的隧道壁点云和地面点云属于背景点云，容易造成虚警，且会显著降低障碍物检测的效率。基于此，针对隧道内障碍物的检测，对隧道壁点云和地面点云的滤除提出了很高要求。
此外，实践中，受激光雷达分辨率、点云稳定性和点云处理算法自身精度等的影响，障碍物位置和尺寸信息常会有所偏差，且障碍物的漏检或误检问题几乎不可避免。为实现障碍物信息的稳定输出，对障碍物的稳定跟踪是不可或缺的。综上要求，本文设计的基于车载激光的障碍物检测算法流程如下：（1）隧道壁点云分割；（2）地面点云分割；（3）目标聚类；（4）目标跟踪。
为简化计算，在隧道壁点云分割之前，本文首先采用VoxelGrid 体素滤波器
[11]
对点云进行下采样处
理，然后再将点云从激光雷达坐标系转换到车辆坐标系。车辆坐标系以向前方向为x 轴的正方向，向上方向为z 轴的正方向，且x 轴、y 轴、z 轴构成右手坐标系。
目标聚类的基本任务是将障碍物点云划分为互斥的若干个子集，每个子集中的激光点云构成一个障碍物。本文采用欧几里得聚类法对障碍物进行聚类。其与隧道待拟合边界点云聚类的区别在于，障碍物聚类时，权重w x =1。聚类完成后，障碍物的中心坐标与尺寸信息可通过计算聚类后点云的轴向平行包围盒得到。相关算法均属于成熟方法，本文不赘述。
3 隧道壁点云分割
隧道壁包括隧道顶和隧道侧壁。显然，隧道顶点云的高程值z 较大。由此，设定高程阈值为T z ，且感
兴趣区域为满足z ≤T z 的区域，即可滤除隧道顶点云的区域。
记滤除隧道顶后留下的点云为P 0。为研究P 0的分布，将P 0向水平面上投影，得到如图2所示的投影点云P 。可以看出，P 表现出明显的带状分布，左右两侧的隧道侧壁点云各形成一条明显的边界点云带。采用曲线对边界点云带进行近似，则可将隧道侧壁的检测问题转换为边界曲线拟合问题。完成边界曲线拟合后，由边界曲线确定隧道侧壁点云，需要将边界曲线朝隧道内部进行等距离偏移，即需要求解边界曲线的等距曲线。
基于以上思想，本文设计的隧道侧壁点云分割方案由5个过程组成：（1）点云栅格图产生；（2）边界点云初选；（3）边界点云复选；（4）边界曲线拟合；（5）边界点云滤除。3.1 点云栅格图的产生
设置栅格的长度L 和宽度W ，将预处理后的点云分配到相应的栅格中。设点云的最小x , y 坐标分别为x min , y min ，那么对于坐标为(x , y , z )的点，其栅格坐标(i , j )满足i =[(x -x min )/L ]，j =[(y -y min )/W ]，其中“[]”表示向下取整算子。
依次处理点云中的所有点，生成点云栅格图Q 。3.2 边界点云的初选
激光雷达在隧道内扫描时，隧道侧壁能返回较多点云，相应的栅格中具有较多的激光点；隧道外部则理论上无点云返回，相应的栅格为空。由此，如图3所示，对于Q 中的每一行栅格，从最左端的栅格
开始遍历，首个非空栅格即为隧道侧壁栅格；从最右端的栅格开始遍历，情况亦然。为降低噪点的影响，
图1 隧道内的激光点云数据
Fig. 1
Point cloud from LiDAR in the tunnel
图2 点云的水平投影视图
Fig. 2
Horizontal projection view of the point cloud
图3 栅格的遍历方式
Fig. 3
The way of traversing all grids
42021年第1期
设置阈值。当栅格内的激光点数不低于该阈值时，将栅格标记为隧道侧壁栅格。
收集所有隧道侧壁栅格中的点云，用于下一步处理。3.3 边界点云的复选
初选的边界点云中从属于左侧隧道壁和右侧隧道壁的点云未被分离，且可能存在不属于任何一侧隧道侧壁的虚假边界点云。这些不足可能会对后续边界曲线拟合造成干扰。
理论上，从属于同一侧隧道壁的边界点云，其中的激光点应具有较小的距离，即在空间上是相邻的，整个边界点云带是连续的、不具有明显间隔的窄长区域；而不同侧隧道壁的边界点云则具有较大的距离，即在空间上不相邻。基于此假设，对于源自左、右侧隧道壁初选的边界点云，可以采用欧几里得聚类方法予以分离。
然而，在实际中，受到障碍物遮挡、隧道侧壁栅格标记错误等因素的影响，从属于同一侧隧道壁的边界点云带可能出现局部断裂现象。此时，边界点云带是在x 方向分段的、有少数明显间隔的窄长区域。
为将分段的窄长区域聚类成一体，需要考虑到x 方向间隔的影响。基于此，对初选的边界点云在x 方向作压缩处理，即对其中的激光点P i (x i , y i )执行缩放变换：
P i (x , y )→P *
i
(w x x , y )， 0<w x ≤1 (3)
式中：w x ——权重。
w x 越小，聚类对x 方向局部断裂的鲁棒性越强，但也增大了将多个独立的仅在x 方向上不相邻的目标聚类为一体的风险。
初选的边界点云经聚类产生多个独立的子点云。其中，隧道侧壁点云在x 方向较长，而虚假边界点云则较隧道侧壁点云明显偏短。基于此，分别计算聚类后产生的子点云在x 方向的长度Δx =x max -x min ，其中x max 和x min 分别为子点云的x 坐标的最大值和最小值。Δx 最大的两个子点云即为两组隧道侧壁边界点云。3.4 边界曲线拟合
采用RANSAC 算法拟合隧道边界曲线，拟合模型为抛物线。设抛物线的二次项、一次项和常数项系数分别为A 1，B 1和C 1，即抛物线方程为y =y (x )=A 1x 2
+B 1x +C 1。超定方程组Pv =q
满足
(4)
显然，C 1>0时拟合所得的为左侧隧道壁边界曲线，反之为右侧隧道壁曲线。为予以区分，分别记左侧、右侧隧道边界曲线为G 1: y =y 1(x )，G 2: y =y 2(x )，G 1和G 2的由二次项、一次项及常数项系数构成的参数向量分别为v 1=[A 11, B 11, C 11]T
，v 2=[A 12, B 12, C 12]T
。3.5 边界点云滤除
隧道边界曲线G 1，G 2的邻域可由它们的等距曲线确定。记G 1，G 2处于隧道内部一侧的等距曲线分别为G *
1，G *
2，对于给定的激光点P i (x i , y i , z i )，若满足P i 在G *
1，G *
2之间，则可认为P i 为非隧道边界点；反之则为隧道边界点。记G *
1和G *
2的曲线方程分别为y =y 1*
(x )，y =y 2*
(x )，则P i 的滤除条件可以表示为(y i -y 1*
)×(y i -y 2*
)≥0。由此，边界点云滤除问题转换为等距曲线G *
1和G *
2的估计问题。
显然，当隧道边界曲线G 1和G 2为抛物线时，等距曲线G *
1和G *2的形式比较复杂；但实际应用中，仍然可以采用抛物线对G *
1和G *
2进行近似，实现对边界点云的滤除。以根据G 1计算G *
1为例，其计算过程如下：
（1）隧道边界采样
对y 1(x )进行等间隔采样，得到由采样点P 1i (i Δx , y 1(i Δx ))（i =0, 1, …, N c -1，N c 为总采样数）构成的采样点集。同时，计算G 1在P 1i 处的单位法向量n i (n ix , n iy )
。
(5)
如果n iy >0，将n i 取反。（2） 等距曲线采样
图4示出等距曲线采样点的生成示意，其中给定邻域半径为r 0。对于给定的隧道边界点P 1i (i Δx , y 1(i Δx ))，可计算等距曲线的采样点：
P *
1i (x *
i , y *
i )=P 1i (i Δx , y 1(i Δx ))+r 0n i
(6)
图4 等距曲线采样点的生成
Fig. 4
Generation of the sample point on the isometric curve
5
曾祥 等：基于车载激光雷达的隧道内障碍物检测
2021年第1期
（3）等距曲线估计
经采样所得的P *1i
(x *i
,
y *i
)均不是局外点，因此可直接应用最小二乘法求解G *1
。
类似地，可求解得出G *2，继而按照条件(y i -y *1
)×(y i -y *2
)≥0滤除所有符合要求的点P i (x i , y i , z i )，保留下来的点云则将用于地面分割。至此，隧道壁点云分割完成。
4 地面点云分割
与隧道壁点云类似，大量的地面点云存在于激光雷达接收到的点云中，需要被滤除。本文采用基础的基于栅格平面拟合的方法进行隧道内的地面点云分割
[12-14]
。沿用隧道侧壁点云分割时的点云栅格图。对每一个栅格，计算其中激光点的个数n 、点云高程的中
值z med 和最小值z min ，并定义该栅格的高程差Δz ：
Δz =2(z med -z min )
(7)
障碍物具有一定的高度，因此其相应栅格应具有较大的高程差，而地面相应栅格高程差较小，据此实现对地面点云的初步筛选。对于起伏较少、仅需考虑坡度因素的地面，如隧道地面，可采用空间平面进行近似。
采用RANSAC 算法拟合地面，拟合模型为平面z =A 2x +B 2y +D 2，其中A 2, B 2, D 2
为系数，则：
(8)
地面点云分割的基本流程如图5所示，具体如下：（1）点云栅格化，计算栅格高程差Δz 。（2）地面栅格点云收集。初始化候选地面点云集合P ，使
。设置阈值T s ，满足Δz ≤T s 的栅格
被视作地面栅格，将该栅格内的点云加入集合P 中。
（3）地面拟合。采用RANSAC 方法拟合P 中的数据，拟合模型为平面∑。
（4）地面点云移除。设定阈值T d ，对P 中的点P i ，计算P i 到平面∑的距离d i 。若P i ≤T d ，则P i 属于地面点，予以移除。
5 目标跟踪
考虑到噪声及其他干扰以及障碍物检测算法自身的局限性，检测得到的多个障碍物位置信息不可避免地存在偏差。为此，有必要引入目标跟踪算法以降低检测偏差。针对单目标跟踪，本文采用成熟的卡尔曼滤波算法；针对多目标的跟踪，先采用成熟的全局最近邻（global nearest neighbour, GNN ）
[15]
数据关联
算法将其分解为多个单目标跟踪问题，然后再应用卡尔曼滤波进行处理。常规的GNN 算法只采用了障碍物的位置信息作为距离准则，在特定场景下的关联效果不佳。为此，本文对距离准则进行改进，以提高GNN 数据关联的鲁棒性。
此外，相比真实情形，聚类结果仍可能存在障碍物的漏检或误检。基于此，本文提出一种基于生命状态转移的航迹管理策略，对聚类给出的结果进行辨识，以快速地实现错误检测的去除和遗漏检测的补充。5.1 改进距离准则的GNN 数据关联
设卡尔曼滤波预测得到的目标A 位置为(x i , y i )，测量目标B 位置为(x j , y j )。将二者间常规的距离定义为
，其中，v ij =(x j -x i , y j -y i )，为A 和B 的
位置残差，S 为卡尔曼滤波中的残差协方差。d 1的定
义只考虑了目标的位置信息而忽略了目标的尺寸信息，可能产生不准确的关联结果。为此，本文引入视觉领域的交并比（intersection over union ，IOU ）概念，并记d 2=2-IOU 且d 2∈[1, 2]。在d 1和d 2的基础上，本文将A 和B 间的距离d 3
定义为
(9)
式(9)中，指数λ反映了d 2的重要性。λ越大，d 2的重要性越高。
图6示出采用仿真数据对d i (i =1, 2, 3)的关联效果进行比较的结果。图6（a ）中，目标R 保持静止，位置坐标相同的目标P 和Q 以相同速度沿直线l 向x 轴正方向运动。显然，因P 和R 的尺寸差异较Q 和R 的小，在同一时刻，P 和R 的关联程度应不低于Q
和R 的，即距离应满足关系d (P , R )≤d (Q , R )；同时，
图5 地面点云分割的流程
Fig. 5
Flow chart of ground segmentation
豫公网安备41160202000603
站长QQ:729038198
关于我们
投诉建议