Kalman Filter in SLAM (7) ——Error-state Iterated Kalman Filter (EsIKF, 误差状态迭代卡尔曼滤波)
文章目录1.EsKF和IEKF公式回顾1.1.EsKF误差状态卡尔曼滤波方程1.2.IEKF迭代扩展卡尔曼滤波方程2.EsIKF公式推导2.1.预测公式2.2.校正公式2.2.1.误差状态观测方程2.2.2.传感器观测误差值2.2.3.校正公式2.3.R2Live中的Es-IKF的校正公式理解2.3.1.IMU+Camera2.3.2.IMU+LiDAR实际EsIKF就是把EsKF和IEKF两个结