c6l4.m

这是zarchan书的fundamentals of kalman filter的matlab原程序.对学习卡尔曼滤波非常有帮助

W0=10.;
count=0;
for W=1:100
	XMAG1=1./sqrt(1.+(W/W0)^2);
	TOP1=1.+2.*(W/W0)^2;
	BOT1=(1.-(W*W/(W0*W0)))^2+2.*(W/W0)^2;
	XMAG2=sqrt(TOP1/(BOT1+.00001));
	TOP2=(1.-2.*W*W/(W0*W0))^2+(2.*W/W0)^2;
	TEMP1=(1.-2.*W*W/(W0*W0))^2;
	TEMP2=(2.*W/W0-(W/W0)^3)^2;
	XMAG3=sqrt(TOP2/(TEMP1+TEMP2+.00001));
	count=count+1;
	ArrayW(count)=W;
	ArrayXMAG1(count)=XMAG1;
	ArrayXMAG2(count)=XMAG2;
	ArrayXMAG3(count)=XMAG3;
end
figure
semilogx(ArrayW,ArrayXMAG1,ArrayW,ArrayXMAG2,ArrayW,ArrayXMAG3),grid
xlabel('Frequency (R/S)')
ylabel('Magnitude')
axis([1 100 0 2])
clc
output=[ArrayW',ArrayXMAG1',ArrayXMAG2',ArrayXMAG3'];
save datfil.txt output /ascii
disp 'simulation finished'