1 文本格式 using System; namespace Legalsoft.Truffer { /// <summary> /// Computes all eigenvalues and eigenvectors of /// a real symmetric matrix by Jacobi's method. /// </summary>
文章目录 对位置 δ α \delta\alpha δα 进行求导位置误差 δ α \delta\alpha δα 对平移 P b k w P^{w}_{b_{k}} Pbkw 的求导位置 δ α \delta\alpha δα 对旋转 R w b k R^{b_{k}}_{w} Rwbk 进行求导 对速度 δ β \delta\beta δβ 进行求导速度 δ β \
用逆深度是因为这样可以在优化中从优化3个变量降低到1个,降低优化的维度加快求解速度 用逆深度是因为当距离很远的时候, 1 x \frac{1}{x} x1 x x x 就会无穷大,而3D点很近的情况也一般不会有,这也是为了数值稳定性 用逆深度的话就要和其中一帧进行绑定,这个就是和观测到该点的第一帧进行绑定,这样才能表示一个3D点信息 划窗中维护的全部都是IMU下的位姿,所以相机要通过外参变
算法流程 其实迭代法前面已经学习过啦,这里的迭代是在前面迭代的基础上的高阶形式——即解决线性方程组的问题。 下面简单介绍雅克比迭代的基本流程。 雅可比迭代 有一线性方程组, A x = b Ax=b Ax=b,其中: 我们可以将其化为以下形式: x i = B x j + f , ( i = 1 , 2 , 3...... n , j = 1 , 2 , 3 , ¬ i . . . .