?? 卡爾曼直流信號濾波.m
字號:
clc;
clear;
z=0.01*randn(1,150)-0.37727;
xx(1)=-0.31;
Q=0.000001;
R=1;
p(1)=0.02;
s(1)= -0.37727;
for k=2:1:150
s(k)= -0.37727;
xs(k)=xx(k-1);
ps(k)=p(k-1)+Q;
K(k)=ps(k)/(ps(k)+R);
xx(k)=xs(k)+K(k)*(z(k)-xs(k));
p(k)=(1-K(k))*ps(k);
end
plot(xx);
hold on
plot(z,'r')
plot(s,'k')
?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -