IMU预积分的过程详解

一、IMU和相机数据融合保证位姿的有效性:

  • 当运动过快时,相机会出现运动模糊,或者两帧之间重叠区域太少以至于无法进行特征匹配,所以纯视觉SLAM对快速的运动很敏感。而有了IMU,即使在相机数据无效的那段时间内,也能保持一个较好的位姿估计,这是纯视觉

    SLAM 无法做到的。

  • 当图像发生变化时,本质上我们没法知道是相机自身发生了运动,还是外界条件发生了变化,所以纯视觉SLAM难以处理动态的障碍物。而IMU能获取自己的运动信息,从某种程度上减轻动态物体的影响

  • IMU虽然可以测得角速度和加速度,但这些量都存在明显的漂移,使得积分两次得到的位姿数据非常不可靠。相比于IMU,相机数据基本不会有漂移,所以相机数据可以有效地估计并修正IMU读数中的漂移使得在慢速运动后的位姿估计依然有效。

二、IMU和Camera数据融合获取位姿的主要流程

1、利用相机和IMU分别进行图像采集和惯性数据采集,且IMU的采集频率大于相机的采集频率

2、提取相机获取的每一顿图像的特征点,然后提取特征点的描述子,匹配特征点计算相机位姿

3、对IMU得到的多组IMU数据进行预积分,计算出两图像对应的IMU的位姿和速度

4、IMU初始化,这一步的目的是获取IMU参数较好的初始值: 速度、重力以及Bias。

三、构建视觉残差惯性残差的统一损失函数进行联合优化

  • 视觉里程计VO通过最小化相关键帧的重投影误差,计算得到相机的位姿和地标的位置
  • IMU对相邻两帧的位姿之间添加约束,而且对每一帧添加了状态量:陀螺仪和加速度的偏差

四、IMU预积分过程

1、IMU测量模型

角速度是陀螺仪得到的, B是刚体,IMU与相机的物体坐标系,W是世界坐标系,与角速度和陀螺仪的偏置有关系,与陀螺仪存在的噪声有关,

加速度是由R旋转乘加速度减重力加速度的差,加速度计的偏置,噪声

2、IMU运动学模型

某一时刻的旋转乘角速度, 速度与加速度是有关系的,位姿也可以通过速度求解出来的

3、基于运动学模型,可得t和t+Δt时刻状态关系

相关推荐
开开心心就好2 天前
解决截图被拦截黑屏问题的免费小工具
安全·智能手机·flink·kafka·pdf·音视频·1024程序员节
开开心心就好7 天前
清理重复文件释放C盘空间的工具
安全·智能手机·pdf·gitlab·音视频·intellij idea·1024程序员节
数据皮皮侠AI11 天前
中国土地利用驱动因子数据集(9种驱动因子/裁剪到省市/Tif)
大数据·人工智能·笔记·能源·1024程序员节
数据皮皮侠AI16 天前
上市公司耐心资本数据(2010-2025)
大数据·人工智能·笔记·能源·1024程序员节
开开心心就好17 天前
解决图片无页码添加功能的实用工具
javascript·python·安全·智能手机·pdf·音视频·1024程序员节
学传打活18 天前
【边打字.边学昆仑正义文化】_25_宇宙动植物的由来(1)
微信公众平台·1024程序员节·汉字·昆仑正义文化
开开心心就好22 天前
用户推荐的文件解锁与强制操作工具
安全·智能手机·pdf·scala·音视频·symfony·1024程序员节
liguojun20251 个月前
软硬一体智慧场馆系统推荐——助力场馆数字化高效升级
java·大数据·人工智能·物联网·1024程序员节
Evand J1 个月前
【课题推荐】UWB的TOA定位方法,与IMU紧耦合,对目标轨迹定位并输出误差统计。适用于二维平面的高精度定位导航
平面·定位·导航·uwb·imu·组合导航·toa
开开心心就好1 个月前
吾爱大佬原创的文件时间修改工具
安全·智能手机·pdf·电脑·智能音箱·智能手表·1024程序员节