本文是EKF的例程
- 状态量是三维、非线性的
- 观测量也是三维、非线性的
在设计模型的时候,我尽量将运动模型设计得复杂一点,这样在后面用它更改的时候从难到简单会方便一点。
另有UKF、CKF等程序源代码在专栏里:https://blog.youkuaiyun.com/callmeup/category_12574912.html
欢迎订阅
程序源码
2024年8月30日,更新到Ver3,如下:
% EKF经典程序
% Evand©2023-2024
% date: 2023-11-07/Ver1
% 2024-4-5/Ver2:添加详细的注释