[发明专利]基于车载环视图像与毫米波雷达融合的智能车定位方法

摘要

本发明公开了一种基于车载环视图像与毫米波雷达融合的智能车定位方法，包括以下步骤：1)通过车载装置采集GPS信息、车载环视图像、毫米波雷达数据和UWB数据，并根据采集的数据生成高精度地图；2)根据待定位车辆采集的GPS数据和地图中每个节点存储的GPS数据进行粗定位；3)根据GPS精度和所在节点确定选取节点的区域范围进行图像级定位；4)计算待定位车辆和制图车辆的位姿关系，确定待定位车辆的位姿；5)将毫米波雷达数据得到的位姿和步骤4)中得到的位姿采用卡尔曼滤波融合，将其结果作为最终定位结果。本发明方法在不增加额外硬件成本的基础上，实现配置有环视图像和毫米波雷达的车辆定位方法，提高定位精度和鲁棒性。

主权项

1.一种基于车载环视图像与毫米波雷达融合的智能车定位方法，其特征在于，包括以下步骤：/n1)通过车载装置采集GPS信息、车载环视图像、毫米波雷达数据和UWB数据，并根据采集的数据生成高精度地图；所述高精度地图是节点化的，每个节点存储该节点所在位置对应的GPS位置信息、环视图像信息、毫米波雷达数据；/n2)将待定位车辆开至已完成高精地图采集和制作的路段，选择任意位置作为起点，计算待定位车辆采集的GPS数据和地图中每个节点存储的GPS数据之间的欧氏距离，选取距离最小值作为粗定位的结果；/n3)根据GPS精度和所在节点确定选取节点的区域范围，将区域中的所有节点作为图像级定位候选节点，利用ORB描述符提取环视图像的全局特征点，将环视图像全局描述符与图像级定位候选节点的全局描述符进行匹配，选择与待定位图像有最小汉明距离的节点作为图像级定位预测结果；/n4)提取待定位原始图像的局部特征点和描述符，采用汉明距离，与图像级定位的结果节点中的地图中环视图像的描述符进行匹配，并用RANSAC去除错误的匹配，从而确定待定位图像与地图集图像中相同的特征点，利用这些特征点，计算待定位车辆和制图车辆的位姿关系，确定待定位车辆的位姿；/n5)提取图像级定位预测结果的定位节点中的毫米波雷达数据，与待定位车辆采集的毫米波雷达的数据进行匹配，通过算法计算待定位车辆和地图中存储的毫米波雷达数据之间的变换关系，求出当前车辆相对于地图车辆的位姿，将毫米波雷达数据得到的位姿和步骤4)中得到的位姿采用卡尔曼滤波融合，将其结果作为最终定位结果。/n