自学内容网 自学内容网

VINS-FUSION 优化-IMU预积分因子(二)

VINS-FUSION 优化-IMU预积分因子(一)完成了IMU预积分及对于优化变量的全部雅克比矩阵的推导,本文结合VINS-FUSION源码,完成优化-IMU预积分因子的使用。

一、IMU预积分因子雅克比

VINS-FUSION源码中将优化变量分组如下:

(p_{b_{i}}^{w}, q_{b_{i}}^{w}), (v_{i}^{w}, b_{i}^{a}, b_{i}^{g}),(p_{b_{j}}^{w}, q_{b_{j}}^{w}), (v_{j}^{w}, b_{j}^{a}, b_{j}^{g})

1.对i时刻优化变量的雅可比


原文地址:https://blog.csdn.net/u010196944/article/details/135744520

免责声明:本站文章内容转载自网络资源,如本站内容侵犯了原著者的合法权益,可联系本站删除。更多内容请关注自学内容网(zxcms.com)!