继上一篇博文Vins-Fusion初始化位姿——3D-2D:PNP求解当前帧位姿,本文继续介绍Vins-Fusion双目初始化时,三角化triangulate。
一、三角化triangulate
三角化triangulate是根据特征点在多个相机下的投影恢复出特征点的3D位置。
二、三角化求解流程
1.遍历当前帧特征点,若该特征点深度为正,说明已经三角化了。
// 已经三角化过
if (it_per_id.estimated_depth > 0)
continue;
2.双目首帧三角化
三角化是根据多个相机下的投影恢复出特征点的3D位置,需要已知相机位姿和投影像素位置(归一化相机平面像素坐标)