VINS-Mono-后端优化 （一：预积分残差计算-IMU预积分约束）
这里先回顾一下预积分是怎么来的
VINS-Mono-IMU预积分 （三：为什么要预积分+预积分推导）
这里贴出预积分的公式
具体含义解释看对对应的文章
整个误差函数如下
预积分 α \alpha α β \beta β γ \gamma γ 是用 IMU 预积分获得的增量（前面用了大篇幅去推导，可以看之前的文章），左边是优化获得的增量，整体就是优化后的值不能离预积分的增量太远，太远的话误差值就会变大
对于四元数就是旋转后的相乘结果尽可能为 0 ， θ → 0 , q = [ 1 , n ⃗ θ 2 ] \theta\rightarrow0,q=[1,\frac{\vec{n}\theta}{2}] θ→0,q=[1,2nθ]，这里有个 1 2 \frac{1}{2} 21 ，所以要乘个2
代码中实际的写法是 ( γ b k + 1 b k ) − 1 ⊗ ( q b k w ) − 1 ⊗ q b k + 1 w (\gamma^{b_{k}}_{b_{k+1}})^{-1}\otimes(q^{w}_{b_{k}})^{-1}\otimes q^{w}_{b_{k+1}} (γbk+1bk)−1⊗(qbkw)−1⊗qbk+1w ，含义是一样的
注意：
这个残差计算是每次优化后都会进来计算的， k + 1 k+1 k+1 时刻（代码中的 j j j）的值就是待优化的值，每次进入函数计算都会被改变，具体计算方法和上面的公式一样，疑问：感觉好像是 i i i 和 j j j 的值同时优化的，后面具体看看代码优化量是哪个？
由于零偏 B a Ba Ba 也是优化变量，而预积分又与零偏有关系，零偏改变了理论上是要重新积分的，但是由于这个零偏量变化很小，所以这里采用一阶近似的方式来更新预积分，更新的预积分继续作为这个约束，零偏更新建模看这篇文章VINS-Mono-IMU预积分 （七：预积分零偏建模方式）
这就是所谓的紧耦合，就是又作为约束又同时优化自身变量
预积分协方差矩阵的使用
前面算出残差 e e e 后，还需要成上信息矩阵（协方差）才行，因为虽然预积分作为约束，但是不是说这个约束是绝对准确的，它是有一个置信度的，前面通过ESKF就是为了计算预积分的置信度
由于现在设置的预积分约束因子，所以前面计算的预积分置信度就是用在这里计算的残差上面，公式为 e T P e e^{T}Pe eTPe，对置信度 P P P 进行 L L T LL^{T} LLT 分解，这个分解相当于是对 P P P 开根号，那么新的残差用 L T e L^{T}e LTe 来当作新的残差。
代码中对置信度取逆是因为，协方差越大代表不确定性越高，则权重应该越小，所以要取逆