VINS_MONO getMeasurements()同步imu数据以及相机特征点帧数据代码逻辑

VINS_MONO getMeasurements()同步imu数据以及相机特征点帧数据代码逻辑

转载:https://blog.csdn.net/huanghaihui_123/article/details/103032782
getMeasurements代码逻辑

imubuf空 或特征点buf空,返回结果
满足两个条件,才进行装载数据:
1.当最新的imu帧(imu_buf.back()) 新过 图像帧(feature_buf.front()+ td )的时间戳(保证了图像帧之前已经没有imu数据了)
2.最旧的imu帧(imu_buf.front()) 旧过 图像帧(feature_buf.front()+ td )的时间戳的(保证了图像帧之前一定要有imu帧)

当最新的imu帧(imu_buf.back()) 没有新过 图像帧(feature_buf.front()+ td )的时间戳的时候, 返回结果。

当最旧的imu帧(imu_buf.front()) 没有旧过 图像帧(feature_buf.front()+ td )的时间戳的时候, 去掉最旧的图像帧。重新进入循环(这种情况只会出现在程序的开头,即,有图像的时候,没有imu,突然来了Imu,这时候,第一帧图像太旧了,就不要这个第一帧的数据)

此时是什么情况?
imu的数据全部在图像帧数据的前面,且至少有一帧IMU帧比图像帧新。有即Imu早于图像帧,现在要把这些比图像帧数据早的imu数据装载到IMUs 的vector里面

接着开始装载IMU的数据

图解说明比较清晰:
在这里插入图片描述
在这里插入图片描述在这里插入图片描述在这里插入图片描述在这里插入图片描述在这里插入图片描述在这里插入图片描述在这里插入图片描述

  • 0
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值