vins-mono:雅可比矩阵的推导

Posted feifanrensheng

tags:

篇首语:本文由小常识网(cha138.com)小编为大家整理,主要介绍了vins-mono:雅可比矩阵的推导相关的知识,希望对你有一定的参考价值。

imu残差公式

技术图片

我们计算雅可比采用加扰动形式

以下是位置增量偏差对旋转qbk的雅可比推导

技术图片

对应的雅可比矩阵的代码

jacobian_pose_i.block<3, 3>(O_P, O_R) = Utility::skewSymmetric(Qi.inverse() * (0.5 * G * sum_dt * sum_dt + Pj - Pi - Vi * sum_dt));

 

以上是关于vins-mono:雅可比矩阵的推导的主要内容,如果未能解决你的问题,请参考以下文章

怎么理解海森矩阵和雅可比矩阵

雅可比矩阵

一元函数的梯度和雅可比矩阵是否想用

雅可比矩阵(偏导数矩阵)的逆矩阵代表啥含义

雅克比矩阵、海森矩阵

jacobian矩阵是啥