orbSLAM2 之 Stereo初始化

orbSLAM2 之 Stereo初始化

对于第一个 特征点数量>500 的帧(Frame)进行初始化。
将其设置为世界坐标系。
以该帧为源帧生成关键帧(KeyFrame),并将该关键帧添加到地图(Map)。
由该帧中所有具有深度的特征生成地图点(MapPoint),关联地图点、关键帧和当前帧。
将关键帧添加到局部地图(LocalMapping)。
保存Tracking类的成员变量:

		//Local
     	mpLocalMapper->InsertKeyFrame(pKFini); 		//将关键帧保存至mpLocalMapper的mlNewKeyFrames,并令mplocalmapper的mbAbortBA=true;
		
		//Last
        mLastFrame = Frame(mCurrentFrame);     			                             
        mnLastKeyFrameId=mCurrentFrame.mnId;//关键帧的源帧id						
        mpLastKeyFrame = pKFini;
		
		//Local  
        mvpLocalKeyFrames.push_back(pKFini);                           
        mvpLocalMapPoints=mpMap->GetAllMapPoints();		//将mvLocalMapPoints赋值为mpMap的mspMapPoints
        
        //Referecnce
        mpReferenceKF = pKFini;                                            //参考关键帧指向新加入的关键帧
        mCurrentFrame.mpReferenceKF = pKFini;           //当前帧的参考关键帧指向新加入的关键帧
		
		//Map
        mpMap->SetReferenceMapPoints(mvpLocalMapPoints);         // 令mpMap的mvpReferenceMapPoints = mvpLocalMapPoints;格式vector<MapPoint*>
        mpMap->mvpKeyFrameOrigins.push_back(pKFini);                 //在 mpMap的vector<KeyFrame*> mvpKeyFrameOrigins中保存当前关键帧
        
		//Drawer
        mpMapDrawer->SetCurrentCameraPose(mCurrentFrame.mTcw);
		
		//状态
        mState=OK;                                                                                                  //状态设置为OK

		
		
  
  


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

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

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

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值