[发明专利]视觉惯导里程计、位姿时序偏差估计方法和定位方法

说明书

本公开实施例公开了视觉惯导里程计、位姿时序偏差估计方法和定位方法。视觉惯导里程计位姿时序偏差估计方法包括：从图像中提取视觉特征，并且建立视觉特征与高精地图的数据关联，所述图像是视觉里程计集成的相机采集的；获取视觉惯导里程计的先验位姿；基于所建立的视觉特征与高精地图的数据关联和视觉惯导里程计的先验位姿，建立视觉惯导里程计位姿时序偏差的估计模型，并且估计所述相机的位姿和视觉惯导里程计位姿时序偏差，可以连续地对视觉惯导里程计的位姿偏差进行估计，而且利用视觉惯导里程计位姿时序偏差的估计模型一起估计出相机的位姿和视觉惯导里程计位姿时序偏差，进而精确地估计视觉惯导里程计的位姿。

技术领域

本公开涉及定位技术领域，具体涉及视觉惯导里程计、位姿时序偏差估计方法和定位方法。

背景技术

目前高精地图的采集通常使用高精度的组合惯导和激光雷达设备。由于成本较高，高精度设备不能满足高频的大范围的高精地图采集，从而较难保证地图的高频更新。廉价的视觉惯导(Visual Inertial，也称为视觉惯性)设备可以大规模部署，通过VIO(视觉惯导里程计或者视觉惯性里程计，Visual Inertial Odometry)、GPS和三维重建，完成对高精地图要素的采集和高频更新。

在机器人学和计算机视觉领域，视觉里程计的定义是通过相机采集到的图像计算其位置和姿态(位姿)的过程，被广泛应用在诸如机器人之类的移动设备领域，例如火星探测车。如果视觉里程计系统同时使用惯性测量元件，这种系统通常被称为视觉惯导里程计(VIO)。为了保证以VIO为基础的高精地图采集系统的精度，在估计VIO位姿时需要修正VIO位姿的时序偏差。时序偏差指的是测量值与真值之间的偏差形成的时间序列。然而，获取VIO位姿的时序偏差是困难的。

发明内容

为了解决相关技术中的问题，本公开实施例提供视觉惯导里程计位姿时序偏差估计方法、视觉惯导里程计定位方法、装置、电子设备、可读存储介质、计算机程序产品和视觉惯导里程计。

第一方面，本公开实施例中提供了一种视觉惯导里程计位姿时序偏差估计方法，所述方法包括：

从图像中提取视觉特征，并且建立视觉特征与高精地图的数据关联，所述图像是视觉里程计集成的相机采集的；

获取所述视觉惯导里程计的先验位姿；

基于所建立的所述视觉特征与高精地图的数据关联和所述视觉惯导里程计的先验位姿，建立视觉惯导里程计位姿时序偏差的估计模型，并且估计所述相机的位姿和视觉惯导里程计位姿时序偏差。

结合第一方面，本公开在第一方面的第一种实现方式中，所述基于所建立的所述视觉特征与高精地图的数据关联和所述视觉惯导里程计的先验位姿，建立视觉惯导里程计位姿时序偏差的估计模型，包括：

基于所建立的所述视觉特征与高精地图的数据关联和所述视觉惯导里程计的先验位姿，分别确定所述视觉惯导里程计的视觉特征重投影误差、先验位姿误差、位姿偏差误差作为所述视觉惯导里程计位姿时序偏差的估计模型中的约束项。

结合第一方面的第一种实现方式，本公开在第一方面的第二种实现方式中，基于所建立的所述视觉特征与高精地图的数据关联和所述视觉惯导里程计的先验位姿，确定所述视觉惯导里程计的视觉特征重投影误差作为所述视觉惯导里程计位姿时序偏差的估计模型中的约束项，包括：

根据所建立的视觉特征与高精地图的数据关联，以获取与视觉特征匹配的地图三维特征；

获取与所述地图三维特征匹配的视觉特征在所述图像上的像素坐标；

基于所述时序位姿变量、所述地图三维特征和与所述地图三维特征匹配的视觉特征在所述图像上的像素坐标，计算所述视觉惯导里程计的视觉特征重投影误差作为所述视觉惯导里程计位姿时序偏差的估计模型中所述视觉特征对所述相机的位姿变量的约束。