maplab系列8:ImuCameraSynchronizer

ImuCameraSynchronizer 是用来同步imu和image的。这是任何vio程序必要的一部分,所以这里单独拿出来分析一下。

首先使用:

  • addCameraImage
    • 把image存入VisualNPipeline中
    • VisualNPipeline本来可以用来提取特征点和track,但这里只用来存储image流,所以使用了NullVisualPipeline类型
    • 使用VisualNPipeline的processImageBlockingIfFull加入新的image
  • addImuMeasurements
    • 新的imu数据存入ImuMeasurementBuffer中

两个函数不断把imu和图片数据加入到对象中

一共有两个线程:

  • checkIfMessagesAreIncomingWorker
    • 检测退出信号
    • 检测最近多少时间内是否没有imu或者img数据收到,异常检测
  • processDataThreadWorker
    • 用getNextBlocking从队列中拿出一张图,如果队列没有图就block在这里。
    • 跳过初始kFramesToSkipAtInit个frame
    • 检查和上一帧时间间隔是否小于min_nframe_timestamp_diff_ns_
    • 建立新的new_imu_nframe_measurement
    • 把这个新的frame给这个结构
    • getImuDataInterpolatedBordersBlocking得到最新frame和上一frame之间所有的imu,如果imu数量不够,会跳过
  • 0
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值