码迷,mamicode.com
首页 > 其他好文 > 详细

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

时间:2019-04-17 15:09:14      阅读:214      评论:0      收藏:0      [点我收藏+]

标签:com   col   src   技术   图片   util   位置   info   style   

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:雅可比矩阵的推导

标签:com   col   src   技术   图片   util   位置   info   style   

原文地址:https://www.cnblogs.com/feifanrensheng/p/10723536.html

(0)
(0)
   
举报
评论 一句话评论(0
登录后才能评论!
© 2014 mamicode.com 版权所有  联系我们:gaon5@hotmail.com
迷上了代码!