[发明专利]自动驾驶车辆的融合定位方法、装置和电子设备

说明书

本申请公开了一种自动驾驶车辆的融合定位方法、装置和电子设备，该方法包括：获取自动驾驶车辆的车侧补盲相机的定位结果和激光定位结果；根据车侧补盲相机的定位结果确定相机定位点到车道线的横向距离，以及根据激光定位结果确定激光定位点到车道线的横向距离；根据相机定位点到车道线的横向距离和激光定位点到车道线的横向距离，确定激光定位的定位状态；根据激光定位的定位状态进行自动驾驶车辆的融合定位，得到自动驾驶车辆的融合定位结果。本申请的自动驾驶车辆的定位方法利用车侧补盲相机的定位结果对激光雷达的定位结果的可信度进行判断，避免了使用可信度较低的激光定位结果进行融合定位导致定位漂移的问题，提高了融合定位精度和稳定性。

技术领域

本申请涉及自动驾驶技术领域，尤其涉及一种自动驾驶车辆的融合定位方法、装置和电子设备。

背景技术

准确、稳定的定位对于自动驾驶车辆至关重要，有了准确、稳定的定位，车辆才能更正确的做出后续规划、控制等操作，才能安全的在道路上行驶。

随着自动驾驶车辆定位精度要求的不断提高，以传统组合导航即IMU（InertialMeasurement Unit，惯性测量单元）+GNSS（Global Navigation Satellite System，全球卫星导航系统）/RTK（Real-time kinematic，实时动态差分）结合地图匹配定位技术的多传感器融合定位方案逐步成为自动驾驶车辆定位方案的首选。目前主流的地图匹配技术分为激光匹配定位和视觉匹配定位，其中激光匹配定位成熟度高，在城市落地场景中成为不可替代一部分。相比较而言，由于受环境、光照影响大，视觉匹配定位技术的稳定性远远不如激光匹配定位，主要应用在自动泊车、室内等限定场景中。

在大部分情况下，激光匹配定位的精度可以保持在厘米级，可用性非常高。但是，由于遮挡、可提取特征少、环境变化等影响，激光匹配定位也会受到影响，进一步输出错误的定位。

除此之外，目前还没有算法能够输出百分百正确的激光匹配定位置信度，即使在某些匹配错误的时候，仍然可能输出较高置信度，导致在融合时使用错误的激光定位信息，使得滤波器融合多传感器定位结果时被短时带偏，导致定位精度和稳定性降低，从而产生人工接管或者急刹等非预期操作。

发明内容

本申请实施例提供了一种自动驾驶车辆的融合定位方法、装置和电子设备，以提高自动驾驶车辆的融合定位精度和稳定性。

本申请实施例采用下述技术方案：

第一方面，本申请实施例提供一种自动驾驶车辆的融合定位方法，其中，所述方法包括：

获取自动驾驶车辆的车侧补盲相机的定位结果和激光定位结果；

根据所述车侧补盲相机的定位结果确定相机定位点到车道线的横向距离，以及根据所述激光定位结果确定激光定位点到车道线的横向距离；

根据所述相机定位点到车道线的横向距离和所述激光定位点到车道线的横向距离，确定激光定位的定位状态；

根据所述激光定位的定位状态进行自动驾驶车辆的融合定位，得到自动驾驶车辆的融合定位结果。

可选地，所述根据所述车侧补盲相机的定位结果确定相机定位点到车道线的横向距离，以及根据所述激光定位结果确定激光定位点到车道线的横向距离包括：

确定自动驾驶车辆是否满足预设初始化条件；

在所述自动驾驶车辆满足预设初始化条件的情况下，根据所述车侧补盲相机的定位结果确定相机定位点到车道线的横向距离，以及根据所述激光定位结果确定激光定位点到车道线的横向距离。

可选地，所述确定自动驾驶车辆是否满足预设初始化条件包括：

获取GNSS/RTK定位结果和GNSS/RTK定位的定位状态；