摘要：PNP算法 在视觉SLAM中，我们通常会有不同的观测数据。 比如单目相机中，我们获取的两帧图像通常只有匹配的像素坐标，这时我们就只能利用对极几何来优化相对位姿，如果我们的特征点分布大体上接近一个平面，那么我们还可以估算两帧间的单应矩阵； 如果我们有RGB-D相机，我们还可以获得匹配像素对应的深度信息 阅读全文

摘要：ICP算法 从这里开始，笔者便秉承恩师的教诲，用一些比较规范的写法来介绍算法原理。 已知条件 匹配的一组三维点云: $$p = \{p_{1}, p_{2}, \dots, p_{n} \}, q = \{q_{1}, q_{2}, \dots, q_{n} \}$$ Tips: （这堆点云一般是根 阅读全文

摘要：单应矩阵原理 单应（透射变换）是射影几何中的概念，又称为射影变换。他把一个射影平面上的点映射到另一个平面对应的位置，并且把直线映射为直线，具有保线性质。与对极几何不同的是，对极几何将点映射到线上，而单应矩阵是点对点的关系。要注意的是单应矩阵的适用场景为：当场景中的特征点都落在同一平面上，比如墙、地面 阅读全文