非线性高斯,各种卡尔曼滤波下的自由落体仿真
总述
以垂直落体为应用背景。
构建EKF、DQEKF、IEKF、CDKF、FBDKF、GHQKF、CKF、SR-UKF、IDKF,并对比结果
- EKF:扩展卡尔曼滤波
- DQEKF:对偶四元数EKF
- IEKF:迭代EKF
- CDKF:中心差分卡尔曼滤波
- GHQKF:高斯-埃尔米特求积KF
- CKF:容积卡尔曼滤波
- SR-UKF:平方根UKF
- IDKF:In direct KF,非直接KF
运行结果
真实值和观测值的各项值的曲线:
各滤波方法的误差
附录:源代码