[发明专利]一种基于高精地图的多传感器融合定位方法及装置

说明书

本发明公开了一种基于高精地图的多传感器融合定位方法及装置，包括步骤：根据车载惯性导航采集的信息获取第一车载惯导定位信息；根据所述第一车载惯导定位信息确定车辆当前位置的高精地图，所述当前位置的高精地图中包含第一地图道路信息；根据前视相机采集的信息获取第一车载相机图像道路信息；将所述第一地图道路信息和所述第一车载相机图像道路信息进行数据关联，生成关联数据信息；融合所述关联数据信息和第一车载惯导定位信息，得到车辆当前位置的高精定位，融合了多个传感器输出的信息包括车载惯导定位信息和车载相机图像道路信息，解决单个设备的应用的局限性，结合高精地图提供的静态信息，通过多个数据融合，保证定位的精度。

技术领域

本发明涉及一种定位技术领域，具体为一种基于高精地图的多传感器融合定位方法及装置。

背景技术

智能驾驶提供了出行便利，近年来逐步得到了生产和应用，自车的位置和朝向即定位，对自动驾驶其他模块如感知、决策和控制等都有着重要的作用，错误的定位信息将带来不可预估的后果。

为了解决车辆定位问题，目前提出了各种各样的解决方法。从传感器层面，有基于纯视觉摄像头、有基于激光雷达、有采用摄像头+毫米波雷达、有结合多个传感器，目前，自动驾驶汽车获取车道线信息的方式是通过智能摄像头；智能摄像头能够从视频图像中检测识别出车道线，实时输出给自动驾驶控制器；摄像头的优点是感知实时性强，检测较为准确。但摄像头也有易受天气、光线等的影响，视野范围有限，易被障碍物遮挡等缺点。当前的视频图像检测识别技术在弯道、路面阴影和路面标线复杂等特殊工况下的性能不能保证。由于当前摄像头的这些特性，在复杂的行驶工况下，自动驾驶汽车的行驶安全性并不能得到保障；从地图层面，有基于高精地图、有不基于高精地图的，而且高精地图的定位格式和表达方式又存在差异；定位技术在自动驾驶领域又是至关重要，因此，如何结合现有的摄像头以及高精地图来提高定位精度十分有必要。

发明内容

为了克服现有技术存在的缺点与不足，本发明公开一种基于高精地图的多传感器融合定位方法及装置，多传感器的设置能够解决单个设备的应用局限性，并结合高精地图提供的丰富的静态信息，得到一个高精度定位，该方法包括步骤：

根据车载惯性导航采集的信息获取第一车载惯导定位信息；

根据所述第一车载惯导定位信息确定车辆当前位置的高精地图，所述当前位置的高精地图中包含第一地图道路信息；

根据前视相机采集的信息获取第一车载相机图像道路信息；

将所述第一地图道路信息和所述第一车载相机图像道路信息进行数据关联，生成关联数据信息；

融合所述关联数据信息和第一车载惯导定位信息，得到车辆当前位置的高精定位。

更进一步地，所述车载惯性导航采集的信息获取第一车载惯导定位信息包括步骤：

获取惯导标定信息，所述惯导标定信息为惯导坐标系与车体坐标系之间的变换矩阵；

根据所述惯导标定信息对所述车载惯性导航进行标定，使得所述车载惯性导航采集车载惯导定位信息；

将所述车载惯导定位信息由所述惯导坐标系转换为所述车体坐标系，生成第一车载惯导定位信息。

更进一步地，所述根据所述第一车载惯导定位信息确定车辆当前位置的高精地图包括步骤：

将所述第一车载惯导定位信息转换至与所述高精地图相同的坐标系，生成第二车载惯导定位信息；

根据所述第二车载惯导定位信息获取车辆在所述当前位置的高精地图。

更进一步地，所述根据前视相机采集的信息获取第一车载相机图像道路信息包括步骤：