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

一种基于4d毫米波雷达的自动泊车车位搜索方法和系统
技术领域
1.本发明涉及雷达点云目标识别的技术领域，更具体地说，是涉及一种基于4d毫米波雷达的自动泊车车位搜索方法和系统。


背景技术：

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


技术实现要素：

4.本发明的目的之一是针对现有的问题，提供一种基于4d毫米波雷达的自动泊车车位搜索方法，利用4d毫米波雷达对自动泊车场景进行环境感知，并将4d毫米波雷达与车辆自身的轮速脉冲数据、车辆的方向盘转角信息、车速信息进行同步关联，以提升测距精度。
5.本发明所要达到的技术效果通过以下技术方案来实现：一种基于4d毫米波雷达的自动泊车车位搜索方法，步骤分为：s1、使用滤波算法滤除雷达点云数据的地杂波和噪声点；s2、使用dbscan算法对雷达点云数据进行点云聚类，表征出真实场景中的实际物体的大致形状；s3、根据聚类结果对每类的物体采用最小外接矩形进行标记；s4、对每个矩形框中的物体边缘进行拟合，得出物体的长度和宽度；s5、在检测区域范围内，以检测到的环境物体的位置位作为参考，计算物体之间闲置空间范围，结合本车的车身尺寸大小，判断是否构成一个空车位的条件。
6.优选地，在进行车位搜索之前，需要获取雷达点云数据和车身数据，并将雷达点云数据和车身数据实时同步。
7.优选地，获取雷达点云数据和车身数据的具体方法为：（1）4d毫米波雷达对环境实时发出电磁波信号，并根据环境感知的情况，通过车辆的主控制器接收毫米波雷达返回的雷达点云数据；（2）利用车辆的非驱动轮的轮速计实时记录轮速脉冲数；（3）利用车身的can总线返回轮速脉冲数据以及车辆的方向盘转角信息、车速信息；
（4）根据can总线实时接收的轮速脉冲数、方向盘转角以及车速信息，实时计算出车辆实时行驶的位移信息。
8.优选地，将雷达点云数据和车身数据实时同步的具体方法为：（1）对毫米波雷达与车辆行驶的位移分别配置时间戳，根据时间戳信息，将毫米波雷达的每帧点云数据与车辆的行驶位移数据进行同步关联；（2）数据同步关联后，将每个雷达点所携带的空间物体的位置信息，由基于雷达的球面坐标系转换成笛卡尔坐标系，并根据关联的车辆行驶位移数据，将雷达点的直角坐标信息转换到当前的车辆坐标系下。
9.优选地，使用滤波算法滤除雷达点云数据的地杂波、噪声点的具体方法为：s1-1、针对毫米波雷达地杂波的特性，设定毫米波雷达点的rcs的阈值为t1，径向距离的阈值为t2以及高度阈值为t3，当雷达点的三个分量均在阈值以内，则判定该雷达点为地杂波并将该地杂波剔除掉；s1-2、采用贝叶斯方法对雷达点云数据进行滤波，通过计算每个雷达点的置信度信息，置信度越高代表该区域的存在概率越高，雷达点信息越有效；置信度越低代表该区域的存在概率越低，极有可能是噪声点；以此标准将噪声点删除掉。
10.优选地，使用dbscan算法对雷达点云数据进行点云聚类的具体方法为：s2-1、通过对点云滤波处理后的数据进行多帧数据累计；s2-2、根据多帧数据的累计情况，采用dbscan聚类算法对点云进行聚类；s2-3、将毫米波雷达对周围环境的感知情况进行区域划分，表征出真实场景中的实际物体的大致形状。
11.优选地，在步骤s3中，根据实时车速设定dbscan的邻域参数（ε，minpts）。
12.除此之外，本发明的第二个目的在于，提供一种基于4d毫米波雷达的自动泊车车位搜索系统，所述系统包括：接收模块，用于接收泊车搜车位请求；点云数据获取模块，用于获取接收到所述泊车搜车位请求时周围环境的点云数据集，所述点云数据集由4d毫米波雷达监测采集得到；车身数据获取模块，用于获取车辆的轮速脉冲数、方向盘转角以及车速信息，以此计算出车辆的实时位移信息；数据同步模块，用于将雷达点的直角坐标信息转换到当前的车辆坐标系下；滤波模块，采用半径滤波将毫米波雷达的地杂波剔除，并采用贝叶斯方法将毫米波雷达的噪声点删除；聚类模块，采用dbscan聚类算法对点云进行聚类，将毫米波雷达对周围环境的感知情况进行区域划分，表征出真实场景中的实际物体的大致形状；边缘拟合模块，用于对每个矩形框中的物体边缘进行拟合，得出物体的长度和宽度；车位判断模块，用于在检测区域范围内，以检测到的环境物体的位置位参考，计算物体之间闲置空间范围，结合本车的尺寸大小，判断是否构成一个空车位的条件；坐标储存模块，用于保存车位类型以及车位坐标，传输至车辆的主控制器。
13.优选地，所述毫米波雷达通过can总线与车辆的主控制器进行电性连接。
14.优选地，所述毫米波雷达为77ghz的角雷达。
15.与现有技术相比，本发明的有益效果：与超声波雷达的车位搜索相比，毫米波雷达的车位搜索检测范围更大，测距精度高，车速范围更大，并携带物体的三维信息以及方向信息，误检率更低。
16.在本发明技术方案中，车辆根据车载的4d毫米波雷达对自动泊车场景进行环境感知，主控制器通过接收毫米波雷达的4d点云数据，通过点云数据对环境的物体进行成像，可检测出车辆、远距的路沿、墙体、绿化带以及地锁等物体。
17.更重要的是，本发明不仅借助了4d毫米波雷达的点云模式来实现四个维度的环境感知，还将4d毫米波雷达与车辆自身的轮速脉冲数据、车辆的方向盘转角信息、车速信息进行同步关联，也就是将4d毫米波雷达与实际的车辆位移信息相配合，从而形成与车速相适应的环境测绘，更加适应实际的泊车情况，减少了因车辆自身运动所导致的误检情况。
附图说明
18.为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据提供的附图获得其他的附图。
19.图1为本发明的工作流程图。
具体实施方式
20.下面结合附图对本发明的具体实施方式作进一步说明。在此需要说明的是，对于这些实施方式的说明用于帮助理解本发明，但并不构成对本发明的限定。此外，下面所描述的本发明各个实施方式中所涉及的技术特征只要彼此之间未构成冲突就可以相互组合。
21.请参阅图1，本实施例提供了一种基于4d毫米波雷达的自动泊车车位搜索方法，步骤总体分为：s1、使用滤波算法滤除雷达点云数据的地杂波和噪声点；s2、使用dbscan算法对雷达点云数据进行点云聚类，表征出真实场景中的实际物体的大致形状；s3、根据聚类结果对每类的物体采用最小外接矩形进行标记；s4、对每个矩形框中的物体边缘进行拟合，得出物体的长度和宽度（进行真实场景的地图构建）；s5、在检测区域范围内，以检测到的环境物体的位置位作为参考，计算物体之间闲置空间范围，结合本车的车身尺寸大小，判断是否构成一个空车位的条件；如若构成空车位，结合参考物体的尺寸，二次判断该空间是垂直车位类别还是水平车位类别。
22.值得注意的是，本技术方案在进行车位搜索之前，需要获取雷达点云数据和车身数据，并将雷达点云数据和车身数据实时同步，使得雷达点云与实际的车辆位移情况相贴合。
23.当中，获取雷达点云数据和车身数据的具体方法为：（1）4d毫米波雷达对环境实时发出电磁波信号，并根据环境感知的情况，通过车辆
的主控制器接收毫米波雷达返回的雷达点云数据；（2）利用车辆的非驱动轮的轮速计实时记录轮速脉冲数；（3）利用车身的can总线返回轮速脉冲数据以及车辆的方向盘转角信息、车速信息；（4）根据can总线实时接收的轮速脉冲数、方向盘转角以及车速信息，实时计算出车辆实时行驶的位移信息。
24.随后，将雷达点云数据和车身数据实时同步的具体方法为：（1）对毫米波雷达与车辆行驶的位移分别配置时间戳，根据时间戳信息，将毫米波雷达的每帧点云数据与车辆的行驶位移数据进行同步关联；（2）数据同步关联后，将每个雷达点所携带的空间物体的位置信息，由基于雷达的球面坐标系转换成笛卡尔坐标系，并根据关联的车辆行驶位移数据，将雷达点的直角坐标信息转换到当前的车辆坐标系下。
25.本实施例中，使用滤波算法滤除雷达点云数据的地杂波和噪声点，确切地说，是分别对雷达点云数据进行滤波预处理、滤波，当中，点云数据滤波预处理是针对毫米波雷达地杂波特性，设定毫米波雷达点的rcs的阈值为t1，径向距离的阈值为t2以及高度阈值为t3，当雷达点的三个分量均在阈值以内，则判定该雷达点为地杂波，搜索系统将该地杂波剔除掉。
26.进行预处理后，采用贝叶斯方法来对雷达点云数据进行滤波，通过计算每个雷达点的置信度信息，置信度越高代表该区域的存在概率越高，雷达点信息有效；置信度越低代表该区域的存在概率越低，极有可能是噪声点；以此标准将噪声点删除掉。
27.对雷达点云数据进行滤波处理之后，需要对车辆周围环境进行检测感知。本发明通过对点云滤波处理后的数据进行多帧数据累计，根据多帧数据的累计情况，采用dbscan聚类算法对点云进行聚类，将毫米波雷达对周围环境的感知情况进行区域划分，表征出真实场景中的实际物体的大致形状。
28.由于车速会影响雷达点云的稀疏度，因此根据实时车速设定dbscan的邻域参数（ε，minpts）。根据聚类结果，对每类的物体采用最小外接矩形法进行标记。
29.在一些实施方案中，还可以通过保存车位类型以及车位坐标，传输至车辆的主控制器，用于后续的路径规划与车辆控制。
30.除此之外，本实施例还提供了一种基于4d毫米波雷达的自动泊车车位搜索系统，所述系统包括：接收模块，用于接收泊车搜车位请求；点云数据获取模块，用于获取接收到所述泊车搜车位请求时周围环境的点云数据集，所述点云数据集由4d毫米波雷达监测采集得到；车身数据获取模块，用于获取车辆的轮速脉冲数、方向盘转角以及车速信息，以此计算出车辆的实时位移信息；数据同步模块，用于将雷达点的直角坐标信息转换到当前的车辆坐标系下；滤波模块，采用半径滤波将毫米波雷达的地杂波剔除，并采用贝叶斯方法将毫米波雷达的噪声点删除；聚类模块，采用dbscan聚类算法对点云进行聚类，将毫米波雷达对周围环境的感
知情况进行区域划分，表征出真实场景中的实际物体的大致形状；边缘拟合模块，用于对每个矩形框中的物体边缘进行拟合，得出物体的长度和宽度；车位判断模块，用于在检测区域范围内，以检测到的环境物体的位置位参考，计算物体之间闲置空间范围，结合本车的尺寸大小，判断是否构成一个空车位的条件；坐标储存模块，用于保存车位类型以及车位坐标，传输至车辆的主控制器。
31.本发明提供的自动泊车车位搜索系统在车辆内设有主控制器，所述4d毫米波雷达采用77ghz的高频高精度角雷达，安装在车辆右侧的b柱，通过can总线与主控制器相连接。
32.在上述的自动泊车车位搜索方法以及系统中，依据4d毫米波雷达的点云数据，可对泊车场景进行感知成像，并对环境中的物体进行聚类和空车位的检测和构造。针对于远距的高低路沿、灌木丛、墙体、雪糕筒、地锁、柱子、木箱、停靠车辆均能有效检测。
33.综上所述，所述自动泊车车位搜索方法以及系统的设计要点在于，通过4d毫米波雷达的点云数据，并结合车身的方向盘转角、车速以及轮速脉冲信号，进行环境的地图构建。根据地图中的目标物体的位置信息，判断空间的空车位的坐标位置，并将搜索到的空车位的信息传输给主控制器。
34.在本发明的描述中，需要理解的是，指示方位或位置关系的术语为基于附图所示的方位或位置关系，仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的设备或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本发明的限制。
35.虽然对本发明的描述是结合以上具体实施例进行的，但是，熟悉本技术领域的人员能够根据上述的内容进行许多替换、修改和变化、是显而易见的。因此，所有这样的替代、改进和变化都包括在附后的权利要求的精神和范围内。