计算机视觉大型攻略 —— SLAM(2) Graph-based(图优化)
前面介绍了基于EKF的SLAM算法。EKF算法由于状态向量,协方差矩阵的大小随着特征点(路标)的增长而迅速增长,导致其不太适合大场景的应用。本文描述基于图优化的SLAM算法。目前由于SLAM图的稀疏性得到广泛认可,这种SLAM在效果和效率上的优势非常明显。 参考文献: [1] Probabilistic Robotics [2] A Tutorial on Graph-Based SLAM [3] Globally consistent range scan alignment for environment mapping. Autonomous Robots [4] A Framework for Sparse, Non-Linear Least Squares Problems on Manifolds [5] INTRODUCTION TO SMOOTH MANIFOLDS Graph-based SLAM [3]最早提出了采用全局优化的图优化SLAM算法。下图摘自[1] Probabilistic Robotics。用图G(V, E)的方式表述了SLAM问题。 上图中, 表示机器人的位姿(Pose), 表示路标(Landmark)的坐标。 图优化中,顶点是优化项,而边是约束项。优化过程就是通过全局调整优化项,使约束项的和最小。在上图中, Pose(x)与Landmark