%===========程序开始==========
%======全选复制粘贴进matlab即可=======
[t,x,xr]=EKF_KALMAN1;
subplot(2,1,1);plot(t,x(1,:));hold on;plot(t,xr(1,:));hold off;
subplot(2,1,2);plot(t,x(2,:));hold on;plot(t,xr(2,:));hold off;
figure;plot(t,xr(3,:));
function [t,y,xr]=EKF_KALMAN1
%应用龙格库塔法法进行迭代计算
%==================================
clc,clear;
m=1;%质量
t0=0;%初始时间
t1=10;%终止时间
dw=0;%激励频率随时间增量
w0=2*pi*5;%初始频率
f=100;%载荷幅值
dt=1e-3;%采样间隔,采样频率导数
c=100;%阻尼大小
H=[1,0,0;0,1,0];%H=dh(x)/dx;