前言
给出自适应容积卡尔曼滤波(ACKF)的MATLAB代码。
主要思想
通过自适应状态协方差Q来实现,得到了比传统方法更低的估计误差。适用于Q无法获取、估计不准、变化不定的情况,只有一个M文件,方便运行,保运行成功,不包讲解。
运行截图
三轴状态的估计曲线:
 
 状态误差的曲线如下:
 
 因为未滤波的误差太大了,将中间红色和黄色部分放大一点,得到下图:

能明显看出来ACKF的误差更小。
 同时,程序还输出了误差的CDF图像,供参考:

 误差的统计特性如下:
 
代码结构
代码文件由以下几个部分组成:
 
完整代码
下载链接:
 https://download.csdn.net/download/callmeup/89382199


















