文章目录 g2o 数据结构 使用步骤 Advance 剔除 Outliers g2o SLAM 中的图优化库。图中的节点是待优化的变量,边是误差。 F ( x ⃗ ) = ∑ k ∈ C e k ⃗ ( x k ⃗ , z k ⃗ ) T Ω k e k ⃗ ( x k ⃗ , z k ⃗ ) F(\vec{x}) = \sum\limits_{k \in C} \vec{e_{k}}(\vec{x_k}, \vec{z_k})^T\Omega_{k}\vec{e_{k}}(\vec{x_k}, \vec{z_k}) F(x )=k∈C∑ek