【技术实现步骤摘要】
定位可靠性检测方法及相关设备
[0001]本申请涉及智能驾驶
,尤其涉及一种定位可靠性检测方法及相关设备。
技术介绍
[0002]自动驾驶汽车强依赖于定位技术,定位是自动驾驶技术中实现其他功能的前提,定位丢失、定位错误将会使得自动驾驶汽车无法正常运行,甚至酿成重大事故。然而,现今的高精度定位方法大部分采用融合定位的方式,这种添加算法进行高精度定位的方法(如视觉里程计、激光里程计)无法给出定位性能的可靠性评判;此处,现阶段的传感器定位设备,一般能够根据观测值得到传感器的定位性能,给出定位误差协方差,该定位误差协方差在一定程度上可以体现定位结果的可靠性,但其置信度不高。由于自动驾驶技术中的规控、感知算法依赖于定位结果,一旦定位结果不准确,将会严重影响自动驾驶技术中的规控、感知算法,使得自动驾驶产生安全隐患。
技术实现思路
[0003]本申请实施例公开了一种定位可靠性检测方法及相关设备,能够对自动驾驶汽车的定位结果进行可靠性检测,有利于降低自动驾驶中的安全隐患。
[0004]本申请实施例第一方面公开了 ...
【技术保护点】
【技术特征摘要】
1.一种定位可靠性检测方法,其特征在于,应用于车载终端,所述方法包括:获取目标车辆的第一定位结果;根据所述第一定位结果和高精度地图确定第一要素图像;根据所述第一要素图像对所述第一定位结果进行可靠性检测,以得到所述第一定位结果的第一检测结果。2.根据权利要求1所述的方法,其特征在于,所述根据所述第一要素图像对所述第一定位结果进行可靠性检测,以得到所述第一定位结果的第一检测结果,包括:将所述第一要素图像输入到目标检测模型中进行处理,以得到所述第一定位结果的第一检测结果;其中,所述目标检测模型是基于视觉几何组网络架构实现的。3.根据权利要求2所述的方法,其特征在于,在将所述第一要素图像输入到目标检测模型中进行处理,以得到所述第一定位结果的第一检测结果之前,所述方法还包括:获取车辆的N个第二定位结果和M个第三定位结果,其中,所述第二定位结果为定位正常的历史定位结果,所述第三定位结果为定位异常的历史定位结果,所述N和所述M为正整数;根据所述N个第二定位结果和高精度地图确定N张第二要素图像,以及根据所述M个第三定位结果和高精度地图确定M张第三要素图像,其中,所述N个第二定位结果与所述N张第二要素图像一一对应,所述M个第三定位结果与M张第三要素图像一一对应;采用所述N张第二要素图像和所述M张第三要素图像对初始检测模型进行训练,得到所述目标检测模型;其中,所述初始检测模型是基于所述视觉几何组网络架构实现的。4.根据权利要求1-3任一项所述的方法,其特征在于,根据目标定位结果和高精度地图通过以下步骤确定目标要素图像:从所述高精度地图中获取预设区域内的地图要素点数据,其中,所述预设区域是基于所述目标定位结果确定的,所述地图要素点数据包括多个地图要素点;将所述多个地图要素点中的每个地图要素点的第一坐标转换成第二坐标,其中,所述每个地图要素点的第一坐标为所述地图要素点在世界坐标系中的坐标,所述第二坐标为所述地图要素点在第二坐标系中的坐标,所述第二坐标系为以所述目标定位结果中的定位坐标为原点的坐标系;根据所述车载终端的摄像头内参将所述每个地图要素点的第二坐标转换成图像坐标,得到所述目标要素图像,其中,所述目标要素图像的像素点坐标为所述图像坐标;其中,若所述目标定位结果为所述第一定位结果,则所述目标要素图像为所述第一要素图像;若所述目标定位结果为所述第二定位结果,则所述目标要素图像为所述第二要素图像;若所述目标定位结果为所述第三定位结果,则所述目标要素图像为所述第三要素图像。5.根据权利要求4所述的方法,其特征在于,根据以下公式将所述第一坐标转换成所述第二坐标:
其中,(X
w
,Y
w
,Z
w
)为所述第一坐标,(X
c
,Y
c
,Z
c
)为所述第二坐标,R为所述目标定位结果中的姿态三自由度的旋转矩阵,T为所述目标定位结果中的定位坐标的平移矩阵。6.根据权利要求5所述的方法,其特征在于,根据以下公式将所述第二坐标转换成图像坐标:其中,(u,v)为所述图像坐标,f
x
、f
y
为所述车载终端的摄像头焦距,u0、v0为相对于成像平面的主点坐标。7.根据权利要求1-6任一项所述的方法,其特征在于,所述方法还包括:若所述第一定位结果直接来自定位传感器,则获取所述定位传感器针对所述第一定位结果确定的定位误差协方差;根据所述第一检测结果和所述定位误差协方差确定所述第一定位结果的第二检测结果。8.根据权利要求1-7任一项所述的方法,其特征在于,所述方法还包括:若所述第一检测结果和所述第二检测结果指示所述第一定位结果正常,则采用所述第一定位结果进行自动驾驶;若所述第一检测结果和/或所述第二检测结果指示所述第一定位结果异常,则警示关闭自动驾驶。9.一种定位可靠性检测装置,其特征在于,应用于车载终端,所述装置包括:获取单元,用于获取目标车辆的第一定位结果;确定单元,用于根据所述第一定位结果和高精度地图确定第一要素图像;检测单元,用于根据所述第一要素图像对所述第一定位结果进行可靠性检测,以得到所述第一定位结果的第一检测结果。10.根据权利要求9所述的装置,其特征在...
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。