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时刻优化变量的雅可比

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值