ORB-SLAM 中的程序笔记记录

1.  mstate   ok  or NOT_INITIALIZED 来进行是否StereoInitialization。

2.初始化结束之后 是onlytracking or

3.// 计算相对姿态T_currentFrame_referenceKeyFrame

cv::Mat Tcr = mCurrentFrame.mTcw*mCurrentFrame.mpReferenceKF->GetPoseInverse();
4.双目初始化:
 步骤1:设定初始位姿:mCurrentFrame.SetPose(cv::Mat::eye(4,4,CV_32F));
步骤2:将当前帧构造为初始关键帧KeyFrame* pKFini = new KeyFrame(mCurrentFrame,mpMap,mpKeyFrameDB);
步骤3:在地图中添加该初始关键帧mpMap->AddKeyFrame(pKFini);
步骤4:为每个特征点构造MapPoint

 

 
posted @ 2017-03-22 15:28  小萝、卜  阅读(350)  评论(0编辑  收藏  举报