一种基于4D毫米波雷达的自动泊车车位搜索方法和系统技术方案

本发明专利技术公开了一种基于4D毫米波雷达的自动泊车车位搜索方法和系统，根据车载的4D毫米波雷达对自动泊车场景进行环境感知，主控制器通过接收毫米波雷达的4D点云数据，通过点云数据对环境的物体进行成像，本发明专利技术不仅借助了4D毫米波雷达的点云模式来实现四个维度的环境感知，还将4D毫米波雷达与车辆自身的轮速脉冲数据、车辆的方向盘转角信息、车速信息进行同步关联，也就是将4D毫米波雷达与实际的车辆位移信息相配合，从而形成与车速相适应的环境测绘，更加适应实际的泊车情况，减少了因车辆自身运动所导致的误检情况。身运动所导致的误检情况。身运动所导致的误检情况。

【技术实现步骤摘要】
一种基于4D毫米波雷达的自动泊车车位搜索方法和系统


[0001]本专利技术涉及雷达点云目标识别的
，更具体地说，是涉及一种基于4D毫米波雷达的自动泊车车位搜索方法和系统。

技术介绍

[0002]在自动泊车系统中，车位搜索系统是自动驾驶车辆通过搭载的车用传感器对周围环境进行感知，主控制根据传感器回传的数据对环境空间的物体位置进行判断，根据物体间的空间位置，输出空车位的在实际场景中的位置信息。主控制器根据车位搜索的信息，进行泊车的路径规划，并实现车辆的自动泊入。车位搜索是自动泊车过程中的第一道工序，而且车位搜索输出的位置精度直接影响到后续路径规划以及车辆泊入的结果。
[0003]而市场中的泊车系统，通常采用超声波雷达的测距数据进行车位搜索。但是超声波雷达的数据无法获取方向信息，且每次传感器接收的数据量较少，通常需要在车辆上安装多个超声波传感器同时工作，以及在车速方面具有局限性，针对路沿以及灌木丛等，识别效果较差，易出现车位漏检问题。

技术实现思路

[0004]本专利技术的目的之一是针对现有的问题，提供一种基于4D毫米波雷达的自动泊车车位搜索方法，利用4D毫米波雷达对自动泊车场景进行环境感知，并将4D毫米波雷达与车辆自身的轮速脉冲数据、车辆的方向盘转角信息、车速信息进行同步关联，以提升测距精度。
[0005]本专利技术所要达到的技术效果通过以下技术方案来实现：一种基于4D毫米波雷达的自动泊车车位搜索方法，步骤分为：S1、使用滤波算法滤除雷达点云数据的地杂波和噪声点；S2、使用DBSCAN算法对雷达点云数据进行点云聚类，表征出真实场景中的实际物体的大致形状；S3、根据聚类结果对每类的物体采用最小外接矩形进行标记；S4、对每个矩形框中的物体边缘进行拟合，得出物体的长度和宽度；S5、在检测区域范围内，以检测到的环境物体的位置位作为参考，计算物体之间闲置空间范围，结合本车的车身尺寸大小，判断是否构成一个空车位的条件。
[0006]优选地，在进行车位搜索之前，需要获取雷达点云数据和车身数据，并将雷达点云数据和车身数据实时同步。
[0007]优选地，获取雷达点云数据和车身数据的具体方法为：（1）4D毫米波雷达对环境实时发出电磁波信号，并根据环境感知的情况，通过车辆的主控制器接收毫米波雷达返回的雷达点云数据；（2）利用车辆的非驱动轮的轮速计实时记录轮速脉冲数；（3）利用车身的CAN总线返回轮速脉冲数据以及车辆的方向盘转角信息、车速信息；
（4）根据CAN总线实时接收的轮速脉冲数、方向盘转角以及车速信息，实时计算出车辆实时行驶的位移信息。
[0008]优选地，将雷达点云数据和车身数据实时同步的具体方法为：（1）对毫米波雷达与车辆行驶的位移分别配置时间戳，根据时间戳信息，将毫米波雷达的每帧点云数据与车辆的行驶位移数据进行同步关联；（2）数据同步关联后，将每个雷达点所携带的空间物体的位置信息，由基于雷达的球面坐标系转换成笛卡尔坐标系，并根据关联的车辆行驶位移数据，将雷达点的直角坐标信息转换到当前的车辆坐标系下。
[0009]优选地，使用滤波算法滤除雷达点云数据的地杂波、噪声点的具体方法为：S1
‑
1、针对毫米波雷达地杂波的特性，设定毫米波雷达点的RCS的阈值为T1，径向距离的阈值为T2以及高度阈值为T3，当雷达点的三个分量均在阈值以内，则判定该雷达点为地杂波并将该地杂波剔除掉；S1
‑
2、采用贝叶斯方法对雷达点云数据进行滤波，通过计算每个雷达点的置信度信息，置信度越高代表该区域的存在概率越高，雷达点信息越有效；置信度越低代表该区域的存在概率越低，极有可能是噪声点；以此标准将噪声点删除掉。
[0010]优选地，使用DBSCAN算法对雷达点云数据进行点云聚类的具体方法为：S2
‑
1、通过对点云滤波处理后的数据进行多帧数据累计；S2
‑
2、根据多帧数据的累计情况，采用DBSCAN聚类算法对点云进行聚类；S2
‑
3、将毫米波雷达对周围环境的感知情况进行区域划分，表征出真实场景中的实际物体的大致形状。
[0011]优选地，在步骤S3中，根据实时车速设定DBSCAN的邻域参数（ε，MinPts）。
[0012]除此之外，本专利技术的第二个目的在于，提供一种基于4D毫米波雷达的自动泊车车位搜索系统，所述系统包括：接收模块，用于接收泊车搜车位请求；点云数据获取模块，用于获取接收到所述泊车搜车位请求时周围环境的点云数据集，所述点云数据集由4D毫米波雷达监测采集得到；车身数据获取模块，用于获取车辆的轮速脉冲数、方向盘转角以及车速信息，以此计算出车辆的实时位移信息；数据同步模块，用于将雷达点的直角坐标信息转换到当前的车辆坐标系下；滤波模块，采用半径滤波将毫米波雷达的地杂波剔除，并采用贝叶斯方法将毫米波雷达的噪声点删除；聚类模块，采用DBSCAN聚类算法对点云进行聚类，将毫米波雷达对周围环境的感知情况进行区域划分，表征出真实场景中的实际物体的大致形状；边缘拟合模块，用于对每个矩形框中的物体边缘进行拟合，得出物体的长度和宽度；车位判断模块，用于在检测区域范围内，以检测到的环境物体的位置位参考，计算物体之间闲置空间范围，结合本车的尺寸大小，判断是否构成一个空车位的条件；坐标储存模块，用于保存车位类型以及车位坐标，传输至车辆的主控制器。
[0013]优选地，所述毫米波雷达通过CAN总线与车辆的主控制器进行电性连接。
[0014]优选地，所述毫米波雷达为77GHz的角雷达。
[0015]与现有技术相比，本专利技术的有益效果：与超声波雷达的车位搜索相比，毫米波雷达的车位搜索检测范围更大，测距精度高，车速范围更大，并携带物体的三维信息以及方向信息，误检率更低。
[0016]在本专利技术技术方案中，车辆根据车载的4D毫米波雷达对自动泊车场景进行环境感知，主控制器通过接收毫米波雷达的4D点云数据，通过点云数据对环境的物体进行成像，可检测出车辆、远距的路沿、墙体、绿化带以及地锁等物体。
[0017]更重要的是，本专利技术不仅借助了4D毫米波雷达的点云模式来实现四个维度的环境感知，还将4D毫米波雷达与车辆自身的轮速脉冲数据、车辆的方向盘转角信息、车速信息进行同步关联，也就是将4D毫米波雷达与实际的车辆位移信息相配合，从而形成与车速相适应的环境测绘，更加适应实际的泊车情况，减少了因车辆自身运动所导致的误检情况。
附图说明
[0018]为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据提供的附图获得其他的附图。
[0019]图1为本专利技术的工作流程图。
具体实施方式
[0020]下面结合附图对本专利技术的具体实施方式作进一步说明。在此需要说明的是，对于这些实施方式的说明用于帮助理解本专利技术，但并不构成对本专利技术的限定本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于4D毫米波雷达的自动泊车车位搜索方法，其特征在于，步骤分为：S1、使用滤波算法滤除雷达点云数据的地杂波和噪声点；S2、使用DBSCAN算法对雷达点云数据进行点云聚类，表征出真实场景中的实际物体的大致形状；S3、根据聚类结果对每类的物体采用最小外接矩形进行标记；S4、对每个矩形框中的物体边缘进行拟合，得出物体的长度和宽度；S5、在检测区域范围内，以检测到的环境物体的位置位作为参考，计算物体之间闲置空间范围，结合本车的车身尺寸大小，判断是否构成一个空车位的条件。2.根据权利要求1所述的方法，其特征在于，在进行车位搜索之前，需要获取雷达点云数据和车身数据，并将雷达点云数据和车身数据实时同步。3.根据权利要求2所述的方法，其特征在于，获取雷达点云数据和车身数据的具体方法为：（1）4D毫米波雷达对环境实时发出电磁波信号，并根据环境感知的情况，通过车辆的主控制器接收毫米波雷达返回的雷达点云数据；利用车辆的非驱动轮的轮速计实时记录轮速脉冲数；利用车身的CAN总线返回轮速脉冲数据以及车辆的方向盘转角信息、车速信息；根据CAN总线实时接收的轮速脉冲数、方向盘转角以及车速信息，实时计算出车辆实时行驶的位移信息。4.根据权利要求3所述的方法，其特征在于，将雷达点云数据和车身数据实时同步的具体方法为：对毫米波雷达与车辆行驶的位移分别配置时间戳，根据时间戳信息，将毫米波雷达的每帧点云数据与车辆的行驶位移数据进行同步关联；数据同步关联后，将每个雷达点所携带的空间物体的位置信息，由基于雷达的球面坐标系转换成笛卡尔坐标系，并根据关联的车辆行驶位移数据，将雷达点的直角坐标信息转换到当前的车辆坐标系下。5.根据权利要求1所述的方法，其特征在于，使用滤波算法滤除雷达点云数据的地杂波、噪声点的具体方法为：S1
‑
1、针对毫米波雷达地杂波的特性，设定毫米波雷达点的RCS的阈值为T1，径向距离的阈值为T2以及高度阈值为T3，当雷达点的三个分量均在阈值以内，则判定该雷达点为地杂波并将该地杂波剔除掉；S1
‑
2、采用贝叶斯方法对雷达点云数据进行滤波，...

【专利技术属性】
技术研发人员：胡娜，陈君立，黄能基，谢朋洲，
申请(专利权)人：惠州市德赛西威智能交通技术研究院有限公司，
类型：发明
国别省市：