Fast-Lio 论文解读

目录

一、系统框架

二、fast-lio的突出点

三、系统模型

3.1 代码中的系统状态：

3.2 State Estimation

3.3  Forward Propagation

3.4 The propagated covariance

3.5 Backward Propagation and motion compensation

3.6 Residual Computation

3.7 Iterated State update

 3.8 prior distribution

3.9 the whole process

四、代码解读

1: get_f 函数

2: df_dx 函数

3： df_dw 函数

4. Fw 与Fi 与论文不对应的原因：

---

一、系统框架

二、fast-lio的突出点

1. 采用紧耦合迭代卡尔曼滤波器融合激光雷达特征点IMU测量；
2. 提出一个正式的反向传播补偿运动失真的过程；
3. 计算卡尔曼增益及其与常规增益的等价性卡尔曼增益公式。新公式有一个计算复杂性取决于状态维度，而不是测量尺寸
4. combine this ICP method with a point- to-edge distance and developed a LiDAR odometry and mapping (LOAM) framework

三、系统模型

3.1 代码中的系统状态：