SLAM ORB-SLAM2(28)PnP估计姿态过程
1. PnPSolver
在 《SLAM ORB-SLAM2(26)重定位过程》 提到的重定位过程中
先计算当前帧特征点的词袋向量ComputeBoW
接着就是用词袋找到与当前帧相似的候选关键帧DetectRelocalizationCandidates
然后通过词袋模型进行初步匹配,紧接着查询较匹配的关键帧,此时先通过PnP投影估计姿态Tcw
/* 4.1.通过PnP算法估计姿态,迭代5次,输出一个相机位姿Tcw,
同时在局部的容器 vbInliers 中记录下匹配的特征点是否为内点,并由 nInliers 记录内点数量*/
PnPsolver *pSolver = vpPnPsolvers[i]