FAST-LIVO2 icon indicating copy to clipboard operation
FAST-LIVO2 copied to clipboard

最终雅可比矩阵 (Fx)

Open RobotGithubLee opened this issue 6 months ago • 2 comments

F_x.block<3, 3>(0, 0) = Exp(angvel_avr, -dt);

F_x.block<3, 3>(3, 7) = Eye3d * dt;

速度对位置的线性影响((δpk+1=δpk+δvkΔt)) 不应该是(3,6)吗?

同理: F_x.block<3, 3>(7, 0) = -R_imu * acc_avr_skew * dt; 不应该是(6,0)吗?

RobotGithubLee avatar May 28 '25 08:05 RobotGithubLee

第三个是曝光时间的倒数

fjz0911fang123 avatar May 28 '25 08:05 fjz0911fang123

顺序可以参考这个函数

https://github.com/hku-mars/FAST-LIVO2/blob/7e884601bcc193e3eabaf1958d4c14cdcff80212/include/common_lib.h#L167-L180

gyyc233 avatar May 28 '25 08:05 gyyc233