一种基于高度密度筛选的激光雷达港区障碍物感知方法技术

本发明专利技术公开了一种基于高度密度筛选的激光雷达港区障碍物感知方法，包括：基于共线准则补全输入激光雷达点云数据中的缺失点；采用降采样方法进行点云信息预处理；通过立方体区域内点数量统计，消除海面反射杂波点；采用k维树结构存储预处理后的数据；自适应的聚类搜索距离阈值选取；对预处理完成后的点云数据进行聚类处理；将处理后的聚类结果集合中的每个点转换到无人艇中心的笛卡尔坐标系下，消除横摇、纵摇、偏航的影响；根据聚类结果集合中的高度信息，剔除海杂波等噪声；从聚类结果集合中提取障碍目标的参数。本发明专利技术实现较为精确地探测跟踪港区内障碍物的方位、距离、形状，减弱海杂波对目标探测的干扰，保障无人艇在港区内安全航行。全航行。全航行。

【技术实现步骤摘要】
一种基于高度密度筛选的激光雷达港区障碍物感知方法


[0001]本专利技术属于无人艇的态势感知方法，特别是一种基于高度密度筛选的激光雷达港区障碍物感知方法。

技术介绍

[0002]无人艇自主航行在离靠泊以及进出港阶段时，要求能够在预先获取的信息基础上，实时精确感知港区的静止和运动物体的位置、形状、运动信息，根据感知信息动态分析是否需要实施避障。由于港区内区域有限、地物和周边建筑物多、障碍物较为密集，导航雷达存在近区为探测盲区、受地物影响大、对目标的分辨率较低等问题，探测港区时虚警率、漏警率激增。光电、摄像头等光学手段也易受到复杂背景的干扰，目标的误检率、漏检率较高，而且没有距离探测数据。所以传统的导航雷达+光学的探测手段在港区内并不适用。
[0003]激光雷达Lidar(Light Detection And Ranging)是一种主动式、以激光束为信息载体的光学遥感技术，融合了传统雷达技术和现代激光技术，大大提高了辐射源的频率，其在大部分方面均优于普通雷达，主要缺点为：作用距离一般小于200米，而且易受物体遮挡。近年来大部分的激光雷达都是面向无人车领域的，使用环境一般为平坦的道路上，探测目标主要为人、车辆、标志物等道路目标，大多为凸形状目标。由于港区内无人艇航行速度相对较慢、海况较为平稳，适合使用激光雷达对港区环境进行感知，而且激光雷达探测精度较高、目标形状较为清晰，能够保障无人艇在狭小区域内也能找到合理的路径避开障碍物。
[0004]无人艇的激光雷达应用与无人车差异较大，无人艇在海上受到的天气影响和风浪流的物理影响大，在航行过程中无人艇姿态一直处于不稳定状态，无人艇平台自身姿态将在风、海流、周边船只运动带起的波浪等环境因素影响下出现不规则的横摇、纵摇等运动，这将大大影响激光雷达探测的精度和探测范围。针对无人艇应用激光雷达感知港区障碍物，现有技术存在的主要问题是：
[0005](1)海上环境复杂多变，但由于激光雷达自身特性，激光的反射在海面上会发生散射，在返回数据中表现为一些零散的离散点，形成多个假目标，现有算法不能有效消除这些假目标；
[0006](2)在船只姿态发生频繁的无规律的变化时，激光雷达无法接受到部分返回光束。现有算法不能解决数据点云缺失的问题，对目标跟踪不稳定；
[0007](3)海上聚类的障碍物种类多样，大多为非凸形状，导致点云数据不完备，目标特征不明确；现有算法对点云数据不完备情况考虑较少，处理不稳定；
[0008](4)激光雷达易受海杂波影响，会探测到周边波浪，真实小目标容易会淹没在杂波中；现有算法对海杂波缺乏剔除手段。

技术实现思路

[0009]本专利技术的目的在于提供一种基于高度密度筛选的激光雷达港区障碍物感知方法，利用无人艇的激光雷达感知输出的点云数据，尽可能地减少无人艇姿态变化、海杂波对探
测的影响，较为精准地定位跟踪港区内的动静态目标，支持无人艇实现自主航行。
[0010]实现本专利技术专利技术目的的技术解决方案为：一种基于高度密度筛选的激光雷达港区障碍物感知方法，包括步骤：
[0011]步骤1、基于共线准则补全激光雷达探测输出点云中的缺失点；
[0012]步骤2、采用降采样方法进行点云信息预处理，减少点云数据量；
[0013]步骤3、通过立方体区域内点数量统计，消除海面反射点；
[0014]步骤4、采用k维树结构存储预处理后的数据；
[0015]步骤5、自适应的聚类搜索距离阈值选取；
[0016]步骤6、对点云数据VRLP进行聚类处理；
[0017]步骤7、将处理后的聚类结果集合VRSet中的每个点转换到无人艇中心的笛卡尔坐标系下，消除横摇、纵摇、偏航的影响；
[0018]步骤8、根据聚类结果集合VRSet中的高度信息，剔除海杂波等噪声；
[0019]步骤9、从聚类结果集合VRSet中提取障碍目标的参数。
[0020]本专利技术与现有技术相比，其显著优点为：
[0021](1)能够根据航行需求优化聚类参数，将激光雷达扫描的点云图进行聚类，分割无人艇周围的障碍物，实现较为精确地确定周围障碍物的方位、距离、形状，这对于后续的避障和路径规划具有重要意义；
[0022](2)能够把航行姿态进行变换，尽可能消除本艇姿态不规则变化的影响；
[0023](3)通过高度过滤，减弱海杂波对目标探测的影响。
[0024]下面结合附图对本专利技术作进一步详细描述。
附图说明
[0025]图1是本专利技术方法的流程示意图。
具体实施方式
[0026]设输入点云的集合为LP＝{lp
i
},且0<i≤N，其中为自然数域，N为自然数，lp
i
＝[lpBm
i
,lpDm
i
,lpAm
i
]，lpBm
i
表示lp
i
点的方位信息，lpDm
i
表示lp
i
点的距离信息，lpAm
i
表示lp
i
点的俯仰信息，都为相对于无人艇激光雷达中心的量测值。结合图1，一种基于高度密度筛选的激光雷达港区障碍物感知方法包括：
[0027]步骤1、基于共线准则补全点云中的缺失点
[0028]由于激光雷达中激光器是随着电机旋转固定频率发射激光进行扫描点测量的，每条扫描线上的点是按照时序关系进行有序排列的，因此可以根据同一扫描线上的点关联关系补全缺失点；按以下步骤实现：
[0029]第一步，将LP按照单帧扫描线归类为LPLineSet＝{LPline
p
}，LPline
p
表示第p根扫描线，LPline
p
＝{lpline
p,t
|lpline
p,t
在第p根扫描线上}。
[0030]第二步，对且则选取距离lpline
p,t
最近的左右各两个LP点记为lp
L1
,lp
R1
,lp
L2
,lp
R2
。计算各点之间角度：
[0031][0032][0033]其中ε为预设的角度门限值。
[0034]第三步，若isEmpty
p,t
为1则认为lpline
p,t
为缺失点，对lp
L1
,lp
R1
,lp
L2
,lp
R2
采用线性插值方式进行补全，将补全后的lpline
p,t
纳入到LP中LP＝LP+lpline
p,t
。
[0035]步骤2、采用降采样方法进行点云信息预处理，减少点云数据量。
[0036]第一步，将激光雷达感知范围均分为S个3维立方体区域{volRl
j
},且0&本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于高度密度筛选的激光雷达港区障碍物感知方法，其特征在于，包括步骤：步骤1、基于共线准则补全激光雷达探测输出点云中的缺失点；步骤2、采用降采样方法进行点云数据预处理；步骤3、基于预处理点云，通过立方体区域内点数量统计，消除海面反射点；步骤4、采用k维树结构存储消除海面反射点后的数据；步骤5、自适应选取聚类搜索距离阈值；步骤6、基于聚类搜索距离阈值，对点云数据进行聚类处理得到聚类集合；步骤7、将聚类集合中的每个点转换到无人艇中心的笛卡尔坐标系下；步骤8、根据聚类结果集合中的高度信息剔除噪声；步骤9、从聚类结果集合中提取障碍目标的参数，确定障碍目标。2.根据权利要求1所述的基于高度密度筛选的激光雷达港区障碍物感知方法，其特征在于，所述步骤1中基于共线准则补全激光雷达探测输出点云中的缺失点具体为：定义点云集合为且0<i≤N，其中为自然数域，N为自然数，lp
i
＝[lpBm
i
,lpDm
i
,lpAm
i
]，lpBm
i
表示lp
i
点的方位信息，lpDm
i
表示lp
i
点的距离信息，lpAm
i
表示lp
i
点的俯仰信息，均为相对于无人艇激光雷达中心的量测值；将LP按照单帧扫描线归类为LPLineSet＝{LPline
p
}，LPline
p
表示第p根扫描线，LPline
p
＝{lpline
p,t
|lpline
p,t
在第p根扫描线上}；对且则选取距离lpline
p,t
最近的左右各两个LP点记为lp
L1
,lp
R1
,lp
L2
,lp
R2
；计算各点之间角度δ
u,v
为：另另其中ε为预设的角度门限值；若isEmpty
p,t
为1则认为lpline
p,t
为缺失点，对lp
L1
,lp
R1
,lp
L2
,lp
R2
采用线性插值方式进行补全，将补全后的lpline
p,t
纳入到LP中LP＝LP+lpline
p,t
。3.根据权利要求2所述的基于高度密度筛选的激光雷达港区障碍物感知方法，其特征在于，所述步骤2中采用降采样方法进行点云数据预处理具体为：步骤2
‑
1，将激光雷达感知范围均分为S个3维立方体区域且0<j≤S，每个volRl
j
＝[vRBm
j,up
,vRDm
j,up
,vRAm
j,up
,vRBm
j,dw
,vRDm
j,dw
,vRAm
j,dw
]，其中vRBm
j,up
、vRBm
j,dw
表示volRl
j
区域的方位上、下界，vRDm
j,up
、vRDm
j,dw
表示volRl
j
区域的距离上、下界，vRAm
j,up
、vRAm
j,dw
表示volRl
j
区域的俯仰上、下界；步骤2
‑
2，对若vRBm
j,dw
≤lpBm
i
≤vRBm
j,up
且vRDm
j,dw
≤lpDm
i
≤vRDm
j,up
且vRAm
j,dw
≤lpAm
i
≤vRAm
j,up
，则将lp
i
纳入到volRl
j
，把所有的点云划分到不同的立方体区域volRl
j
中；步骤2
‑
3，对于把划分到volRl
j
中lp
i
的距离、方位、俯仰进行平均，得到volRl
j
的质心位置vrlp
j
＝[vrlpBm
j
,vrlpDm
j
,vrlpAm
j
]；步骤2
‑
4，将所有非零的vrlp
j
组合成一个新的点云集合VRLP＝{vrlp
j
|vrlp
j
≠[0,0,
0]}。4.根据权利要求3所述的基于高度密度筛选的激光雷达港区障碍物感知方法，其特征在于：所述步骤3中通过立方体区域内点数量统计，消除海面反射点，具体为：根据立方体区域内点数量删除离散的海面反射点，统计每个volRl
j
中lp
i
的数量NOfvolRl
j
，若NOfvolRl
j
<α，α为预定的门限值，则将volRl
j
从VRLP中删除VRLP＝VRLP
‑
volRl
j
。5.根据权利要求4所述的基于高度密度筛选的激光雷达港区障碍物感知方法，其特征在于，所述步骤4中采用k维树结构VRLPKd存储消除海面反射点后的数据VRLP,具体为：步骤4
‑
1，另待处理k维二叉树数据集合kdLPData＝VRLP,数据所在空间集合kdLPRange＝VRLP；步骤4
‑
2，随着树的深度轮流选择距离、方位、俯仰为轴垂直分割面vrplsplit，即其中Tie为二叉树层数；步骤4
‑
3，确定该层的数据域，按照轴垂直分割面给kdLPData的值排序，另轴垂直分割面vrplsplit为距离vrplDm，则按vrlpDm
j
的值进行排序；将位于正中间的数据点vrlp
j
记为kdLPNode＝[knBm,knDm,knAm]，另kdLPData＝kdLPData
‑
kdLPNode；如果vrplsplit＝vrplDm，则：kdLPDataleft＝{vrlp
j
|vrlp...

【专利技术属性】
技术研发人员：蔡庆，朱磊，高峰端，郑金华，王清波，袁文亮，
申请(专利权)人：中国船舶集团有限公司第七一六研究所，
类型：发明
国别省市：