视觉SLAM笔记（37） 求解 PnP

---

1. 使用 EPnP 求解位姿

首先，用 OpenCV 提供的 EPnP 求解 PnP 问题，然后通过 g2o 对结果进行优化

创建/VSLAM_note/037/pose_estimation_3d2d文件
由于 PnP 需要使用 3D 点，为了避免初始化带来的麻烦
使用了 RGB-D 相机中的深度（1_depth.png），作为特征点的 3D位置

首先来看 OpenCV 提供的 PnP 函数：

int main(int argc, char** argv)