视觉惯性里程计参数值更新方法、装置、设备及存储介质制造方法及图纸

技术编号:38706994 阅读:12 留言:0更新日期:2023-09-08 14:47
本申请是关于一种视觉惯性里程计参数值更新方法、装置、设备及存储介质。该方法包括:获取视觉惯导里程计观测目标图像得到的特征点,通过预设方式确定所述特征点的预设参数初值;根据所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值;对同一特征点的至少两个预设参数测量值进行融合处理,得到融合后的所述特征点的预设参数目标值;将所述预设参数初值更新为所述预设参数目标值。本申请提供的方案,能够得到更准确的参数值,使得VIO可以根据参数值输出更准确的位姿结果。可以根据参数值输出更准确的位姿结果。可以根据参数值输出更准确的位姿结果。

【技术实现步骤摘要】
视觉惯性里程计参数值更新方法、装置、设备及存储介质


[0001]本申请涉及定位
,尤其涉及一种视觉惯性里程计参数值更新方法、装置、设备及存储介质。

技术介绍

[0002]视觉惯性里程计(visual

inertial odometry,VIO)最主要的目的就是输出高精度的定位结果,因此,如何提升VIO输出位姿的精度成为视觉SLAM(即时定位与地图构建,Simultaneous Localization and Mapping)中最重要的问题。
[0003]相关技术中,在双目VIO系统中,可以确定出设定参数例如特征点的逆深度值或深度值提供给后端进行位姿计算。其中逆深度是深度的倒数,是一个标量。以逆深度为例,某个特征点的逆深度主要是靠左右目图像帧的三角化来计算的,如果左目或者右目的位姿不准确,即会造成计算的逆深度存在较大的偏差,使得特征点的位置不准确,从而增大重投影误差,致使VIO输出位姿的精度降低。
[0004]因此,如何给后端优化器提供更加准确的设定参数值例如逆深度值或深度值,以使其更接近真实值,从而提高VIO输出位姿的精度,已成为本领域技术人员亟待解决的问题。

技术实现思路

[0005]为克服相关技术中存在的问题,本申请提供一种视觉惯性里程计参数值更新方法、装置、设备及存储介质,能够得到更准确的参数值,使得VIO可以根据参数值输出更准确的位姿结果。
[0006]本申请第一方面提供一种视觉惯性里程计参数值更新方法,包括:
[0007]获取视觉惯导里程计观测目标图像得到的特征点,通过预设方式确定所述特征点的预设参数初值;
[0008]根据所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值;
[0009]对同一特征点的至少两个预设参数测量值进行融合处理,得到融合后的所述特征点的预设参数目标值;
[0010]将所述预设参数初值更新为所述预设参数目标值。
[0011]在一实施方式中,所述通过预设方式确定所述特征点的预设参数初值,包括:
[0012]通过对所述特征点进行三角化处理,确定所述特征点的深度初值或逆深度初值,其中所述逆深度初值根据所述深度初值得到。
[0013]在一实施方式中,所述根据所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值,包括:
[0014]根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值;或,
[0015]根据所述特征点的深度初值进行概率分布建模,得到深度测量值。
[0016]在一实施方式中,所述根据所述特征点的逆深度初值进行概率分布建模,得到逆
深度测量值,包括:
[0017]根据所述特征点的深度初值确定所述特征点的逆深度均值和逆深度方差;
[0018]利用所述逆深度均值和逆深度方差确定概率分布函数值作为逆深度测量值;或,
[0019]所述根据所述特征点的深度初值进行概率分布建模,得到深度测量值,包括:
[0020]根据所述特征点的深度初值确定所述特征点的深度均值和深度方差;
[0021]利用所述深度均值和深度方差确定概率分布函数值作为深度测量值。
[0022]在一实施方式中,所述根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值,包括:
[0023]遍历所述目标图像中观测到所述特征点的关键帧,根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值;或,
[0024]所述根据所述特征点的深度初值进行概率分布建模,得到深度测量值,包括:
[0025]遍历所述目标图像中观测到所述特征点的关键帧,根据所述特征点的深度初值进行概率分布建模,得到深度测量值。
[0026]在一实施方式中,所述遍历所述目标图像中观测到所述特征点的关键帧,根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值,包括:
[0027]遍历所述目标图像中观测到所述特征点的关键帧,
[0028]在当前关键帧为观测到所述特征点的起始帧时,根据同一当前关键帧的左目图像位姿和右目图像位姿中特征点的逆深度初值进行概率分布建模,得到逆深度测量值;或,
[0029]在当前关键帧为观测到所述特征点的非起始帧时,根据起始帧的左目图像位姿和当前关键帧的左目图像位姿中特征点的逆深度初值进行概率分布建模,得到逆深度测量值。
[0030]在一实施方式中,所述遍历所述目标图像中观测到所述特征点的关键帧,根据所述特征点的深度初值进行概率分布建模,得到深度测量值,包括:
[0031]遍历所述目标图像中观测到所述特征点的关键帧,
[0032]在当前关键帧为观测到所述特征点的起始帧时,根据同一当前关键帧的左目图像位姿和右目图像位姿中特征点的深度初值进行概率分布建模,得到深度测量值;或,
[0033]在当前关键帧为观测到所述特征点的非起始帧时,根据起始帧的左目图像位姿和当前关键帧的左目图像位姿中特征点的深度初值进行概率分布建模,得到深度测量值。
[0034]在一实施方式中,所述根据所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值,包括:
[0035]在所述特征点被观测到的次数大于预设阈值时,根据所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值。
[0036]在一实施方式中,所述概率分布建模包括高斯分布建模或高斯

均匀混合分布模型建模。
[0037]本申请第二方面提供一种视觉惯性里程计参数值更新装置,包括:
[0038]初值模块,用于获取视觉惯导里程计观测目标图像得到的特征点,通过预设方式确定所述特征点的预设参数初值;
[0039]建模模块,用于根据所述初值模块确定的所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值;
[0040]融合模块,用于对所述建模模块得到的同一特征点的至少两个预设参数测量值进行融合处理,得到融合后的所述特征点的预设参数目标值;
[0041]更新模块,用于将所述初值模块确定的预设参数初值更新为所述融合模块得到的预设参数目标值。
[0042]本申请第三方面提供一种电子设备,包括:
[0043]处理器;以及
[0044]存储器,其上存储有可执行代码,当所述可执行代码被所述处理器执行时,使所述处理器执行如上所述的方法。
[0045]本申请第四方面提供一种非暂时性机器可读存储介质,其上存储有可执行代码,当所述可执行代码被电子设备的处理器执行时,使所述处理器执行如上所述的方法。
[0046]本申请提供的技术方案可以包括以下有益效果:
[0047]本申请提供的方案,在通过预设方式确定所述特征点的预设参数初值之后,再根据所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值;对同一特征点的至少两个预设参数测量值进行融合处理,得到融合后的所述特征点的预设参数目标值;将所述预设参数初值更新为所述本文档来自技高网
...

【技术保护点】

【技术特征摘要】
1.一种视觉惯性里程计参数值更新方法,其特征在于,包括:获取视觉惯导里程计观测目标图像得到的特征点,通过预设方式确定所述特征点的预设参数初值;根据所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值;对同一特征点的至少两个预设参数测量值进行融合处理,得到融合后的所述特征点的预设参数目标值;将所述预设参数初值更新为所述预设参数目标值。2.根据权利要求1所述的方法,其特征在于,所述通过预设方式确定所述特征点的预设参数初值,包括:通过对所述特征点进行三角化处理,确定所述特征点的深度初值或逆深度初值,其中所述逆深度初值根据所述深度初值得到。3.根据权利要求2所述的方法,其特征在于,所述根据所述特征点的预设参数初值进行概率分布建模,得到预设参数测量值,包括:根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值;或,根据所述特征点的深度初值进行概率分布建模,得到深度测量值。4.根据权利要求3所述的方法,其特征在于:所述根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值,包括:根据所述特征点的深度初值确定所述特征点的逆深度均值和逆深度方差;利用所述逆深度均值和逆深度方差确定概率分布函数值作为逆深度测量值;或,所述根据所述特征点的深度初值进行概率分布建模,得到深度测量值,包括:根据所述特征点的深度初值确定所述特征点的深度均值和深度方差;利用所述深度均值和深度方差确定概率分布函数值作为深度测量值。5.根据权利要求3所述的方法,其特征在于:所述根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值,包括:遍历所述目标图像中观测到所述特征点的关键帧,根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值;或,所述根据所述特征点的深度初值进行概率分布建模,得到深度测量值,包括:遍历所述目标图像中观测到所述特征点的关键帧,根据所述特征点的深度初值进行概率分布建模,得到深度测量值。6.根据权利要求5所述的方法,其特征在于,所述遍历所述目标图像中观测到所述特征点的关键帧,根据所述特征点的逆深度初值进行概率分布建模,得到逆深度测量值,包括:遍历所述目标图像中观测到所述特征点的关键帧,在当前关键帧为观测到所述特征点的起始帧时,根据同一当前关键帧的左目图像位姿和右目图像位姿中特征点的逆深度初值进行...

【专利技术属性】
技术研发人员:董博陶永康彭登傅志刚
申请(专利权)人:广东汇天航空航天科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1