基于4D毫米波雷达的地下停车库可通行空间检测方法技术

本方案涉及汽车雷达应用技术领域，具体涉及一种基于4D毫米波雷达的地下停车库可通行空间检测方法，本方案采用车载4D毫米波雷达进行可通行空间检测，包括下列步骤：1.从以太网获得云数据；2.对云数据进行三维空间聚类；3.删除未聚类成功的杂点；4.删除高度值不满足阈值的聚类点；5.从云数据中获取可通行空间的边界点；6.在上位机中显示可通行空间的边界点。本方案通过4D毫米波雷达检测，采用聚类算法处理，对检测出的障碍物进行高度计算，将杂点和障碍物反射的点云进行区分，再将可通行空间用边界关键点形成的边框输出，使得可通行空间的显示更加精确，同时反应速度更快。同时反应速度更快。同时反应速度更快。

【技术实现步骤摘要】
基于4D毫米波雷达的地下停车库可通行空间检测方法


[0001]本专利技术涉及汽车雷达应用
，具体涉及一种基于4D毫米波雷达的地下停车库可通行空间检测方法。

技术介绍

[0002]在智能驾驶领域，自动泊车技术快速发展，地下停车库场景的多传感器感知融合技术成为自动泊车技术的重要组成部分。其中，毫米波雷达具有探测范围广，障碍物坐标、速度、高度信息探测相对准确等优点，并且可以在全天候环境下工作，因此，毫米波雷达被广泛装配于车载感知传感器。
[0003]其他传感器中，视觉传感器作为一种被动传感器，对外界环境光照及光照变化敏感，并且只能识别训练数据中标注的物体类别，具有局限性，可通行空间的检测鲁棒性较差；激光雷达具有高可靠的障碍物检测能力、检测精度高、分辨率高等优势，但其成本高昂，也不能全天候工作。
[0004]专利CN110008941B描述一种方法，利用车载毫米波雷达提供的目标信噪比等特征，通过融合多个传感器数据，引入平滑算法，综合考虑障碍物位置与速度等特征信息，结合Bresenham算法，对求得的栅格地图进行高斯滤波后，更新栅格地图状态，将可通行空间的检测结果实时输出；但是该方法不能很好的适用于地下停车库等室内封闭场景，因为地下停车库天花板多铺设有金属管道等反射特性强的物体，车道上方的天花板将会被探测到很多点云，这些点云投影到地面二维坐标系下时，将会被误检为不可通行，导致误检率上升，甚至可通行空间检测方法的失效。
[0005]因此，需要开发一种基于毫米波雷达的适用于地下停车库等室内封闭场景的可通行空间检测方法。

技术实现思路

[0006]针对现有技术存在的上述不足，本专利技术的目的在于提供一种基于4D毫米波雷达的地下停车库可通行空间检测方法，能够进行全天候全地形环境工作，同时还能够对可通行空间实时精确的传输。
[0007]本专利技术采用如下技术方案，一种基于4D毫米波雷达的地下停车库可通行空间检测方法，其特征在于，所述可通行空间检测方法包括以下步骤：步骤1，通过以太网获取4D毫米波雷达点云数据；步骤2，对点云数据在三维空间上进行聚类；步骤3，从点云数据中删除未聚类成功的杂点；步骤4，从点云数据中删除高度值不满足阈值的聚类点；步骤5，从点云数据中获取可通行空间的边界点；步骤6，在上位机中显示可通行空间的边界点。
[0008]进一步地，步骤1中，获取4D毫米波雷达点云数据的具体过程包括：
步骤1
‑
1，通过以太网udp协议，按照一定周期从雷达读取一帧探测数据；步骤1
‑
2，先对读取雷达的一帧数据进行物理值转换，根据车辆坐标系定义和三角函数关系，把距离、方位角和俯仰角值转换为X、Y、Z坐标值，然后再把坐标值转换到车辆坐标系下，形成点云数据，并存储在全局变量中。
[0009]进一步地，所述探测数据包括距离、方位角、俯仰角、速度以及信噪比。
[0010]进一步地，步骤2中，所述的对点云数据在三维空间上进行聚类的具体过程包括：步骤2
‑
1，初始化一个点的对象容器，并将点云数据存储到该容器中，点的对象包含以下成员变量：坐标X/Y/Z、编号ID、是否已访问标志Visited、簇ClusterID、是否核心点标志IsKey、邻域点列表；步骤2
‑
2，设置聚类参数；步骤2
‑
3，从点云数据中任意选取一个点，将该点Visited属性标记为已访问，计算该点的邻域半径R内点的个数PtsNum，如果点的个数PtsNum大于设置的阈值MinPts，则将该点的IsKey属性标记为核心点，并且分配一个簇ClusterID；同时遍历该点邻域半径R内所有点进行以下操作，将点Visited属性标记为已访问，分配同样的簇ClusterID，并且对这些点重复进行步骤2
‑
3的操作，直到遍历访问点云数据中所有的点之后结束；步骤2
‑
4，对于聚类成功的点云簇，计算出每个点云簇的平均Z坐标，并存储到变量ClassZInfo中。
[0011]进一步地，步骤3中，所述从云数据中删除未聚类成功的杂点的具体过程为：遍历每个点云数据，读取每个点的簇ClusterID属性，如果ClusterID值为0，则将该点移出容器，否则跳过该点，保留该点在容器中。
[0012]进一步地，步骤4中，所述从云数据中删除高度值不满足阈值的聚类点的具体过程包括：步骤4
‑
1，根据实车尺寸和雷达高度设置点云簇的高度阈值参数，设定以下变量：最小Z坐标值PtMinZ和最大Z坐标值PtMaxZ；步骤4
‑
2，遍历每个点云数据，读取每个点的簇ClusterID属性，并从变量ClassZInfo中读取该ClusterID点云簇的平均Z坐标值，如果该Z坐标值大于PtMaxZ阈值或小于PtMinZ阈值，则将该点云簇中的每个点都移出容器中，否则，则跳过该点云簇，保留该点云簇在容器中。
[0013]进一步地，步骤5中，所述的从点云数据中获取可通行空间的边界点的具体过程包括：步骤5
‑
1，遍历每个点云数据，计算每个点与坐标原点的距离，和原点到该点向量在坐标系下的角度；步骤5
‑
2，将点云数据按照坐标系下的角度从0度到360度进行排序，设置角度参数阈值AngResolution；步骤5
‑
3，制定以下筛选可通行空间的边界点规则，以坐标系原点为中心，按照AngResolution阈值角度间隔将坐标系XY平面划分为若干个扇形区域；然后遍历每个点云数据，找出每一个扇形区域中与坐标原点距离最近的点，并存储到变量FreeSpacePt中，这些点即是所获取的可通行空间的边界点。
[0014]进一步地，步骤6中，所述在上位机中显示可通行空间的边界点的具体过程包括：
遍历步骤5
‑
3最终输出变量FreeSpacePt中的每一个点，并作图。
[0015]相比现有技术，本方案具有如下有益效果：1、本方案通过聚类算法，将障碍物反射的点云和杂点区分出来，从而删除掉杂点和虚假点，能有效过滤环境中80%的杂点，提高可行使区域检测的准确性。
[0016]2、本方案利用4D毫米波雷达的俯仰探测能力，计算出聚类后的天花板及其他干扰物反射的点云高度，再通过与设定的阈值比较，能有效过滤90%的地下停车库等室内封闭场景下天花板反射杂点问题，极大的保证了可行使区域检测的准确性。
[0017]3、本方案的最终输出为一系列的边界关键点，而不是以栅格地图的形式输出，不仅精确表征了可通行空间的范围，也简化了数据传输量，对于可通行空间的使用者，降低了数据处理复杂度和处理器运算时间，提高了效率。
附图说明
[0018]图1本专利技术的检测流程图。
[0019]图2本专利技术一种实施例中上位机可通行空间的显示图。
具体实施方式
[0020]下面将结合附图及实施例对本专利技术作进一步说明。
[0021]实施例：参见本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于4D毫米波雷达的地下停车库可通行空间检测方法，其特征在于，所述可通行空间检测方法包括以下步骤：步骤1，通过以太网获取4D毫米波雷达点云数据；步骤2，对点云数据在三维空间上进行聚类；步骤3，从点云数据中删除未聚类成功的杂点；步骤4，从点云数据中删除高度值不满足阈值的聚类点；步骤5，从点云数据中获取可通行空间的边界点；步骤6，在上位机中显示可通行空间的边界点。2.根据权利要求1所述的基于4D毫米波雷达的地下停车库可通行空间检测方法，其特征在于，步骤1中，获取4D毫米波雷达点云数据的具体过程包括：步骤1
‑
1，通过以太网udp协议，按照一定周期从雷达读取一帧探测数据；步骤1
‑
2，先对读取雷达的一帧数据进行物理值转换，根据车辆坐标系定义和三角函数关系，把距离、方位角和俯仰角值转换为X、Y、Z坐标值，然后再把坐标值转换到车辆坐标系下，形成点云数据，并存储在全局变量中。3.根据权利要求2所述的基于4D毫米波雷达的地下停车库可通行空间检测方法，其特征在于，所述探测数据包括距离、方位角、俯仰角、速度以及信噪比。4.根据权利要求2所述的基于4D毫米波雷达的地下停车库可通行空间检测方法，其特征在于，步骤2中，所述的对点云数据在三维空间上进行聚类的具体过程包括：步骤2
‑
1，初始化一个点的对象容器，并将点云数据存储到该容器中，点的对象包含以下成员变量：坐标X/Y/Z、编号ID、是否已访问标志Visited、簇ClusterID、是否核心点标志IsKey、邻域点列表；步骤2
‑
2，设置聚类参数；步骤2
‑
3，从点云数据中任意选取一个点，将该点Visited属性标记为已访问，计算该点的邻域半径R内点的个数PtsNum，如果点的个数PtsNum大于设置的阈值MinPts，则将该点的IsKey属性标记为核心点，并且分配一个簇ClusterID；同时遍历该点邻域半径R内所有点进行以下操作，将点Visited属性标记为已访问，分配同样的簇ClusterID，并且对这些点重复进行步骤2
‑
3的操作，直到遍历访问点云数据中所有的点之后结束；步骤2
‑
4，对于聚类成功的点云簇，...

【专利技术属性】
技术研发人员：张博，任凡，史双武，宋高飞，顾施张，张滋，
申请(专利权)人：重庆长安汽车股份有限公司，
类型：发明
国别省市：