orbSLAM2 之 追踪

本文详细介绍了orbSLAM2系统中追踪模块的工作流程,包括初始化、位姿估计、局部地图追踪、关键帧创建等核心步骤。适用于理解SLAM系统如何实时定位和构建环境地图。

摘要生成于 C知道 ,由 DeepSeek-R1 满血版支持, 前往体验 >

orbSLAM2 之 追踪

简介:

TRACKING线程图像预处理之外的内容。
估计当前帧的位姿,并决定是否创建和创建新关键帧。
函数Tracking::Tack()。

流程:

1,如果系统还没有初始化,进行初始化。
  双目/RGBD 初始化:函数StereoInitialization()。
  单目初始化:函数MonocularInitialization()。
  
2,如果已经初始化,且状态(mState)=OK,则初步计算当前帧的位姿(SLAM系统)。
  如果当前帧是初始化后的第二帧,或者上一帧的速度(mVelocity)无效,则采用追踪参考关键帧计算。
  反之,采用运动模型追踪计算。
  如果运动模型追踪计算失败,则采用追踪参考关键帧计算

3,如果已经初始化,但状态(mState)=LOST,则重定位,函数Relocalization()。

4,如果当前帧位姿初步计算成功,则追踪局部地图。函数TrackLocalMap()。

5,如果[追踪局部地图]成功,则:
  更新运动模型(帧速度mVelocity);
  去除当前帧匹配的地图点中的外点;
  判断是否创建新关键帧,如是,则创建新关键帧(含相应地图点)。
  函数:NeedNewKeyFrame() 及  CreateNewKeyFrame()。

6,如果[追踪局部地图]失败,则:
  判断已有的关键帧是否超过5个,如不到5个,则重置系统,函数Reset()。

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值