三维滤波,非线性系统状态与非线性观测,使用EKF和PF进行滤波,输出滤波值曲线与误差对比。 结果 三轴状态估计: 三轴状态估计误差曲线: 放大一点得到下图: MATLAB程序 % EKF+PF效果对比 % author:Evand % 作者联系方式:evandjiang@qq.com(除前期达成一致外,咨询需付费) % date: 2024-1-10 % Ver2 clear;clc;close all