%例程7－13自適應(yīng)陷波濾波器
%自適應(yīng)陷波器仿真
clear all
clc
 
N=400;                      %總采樣長(zhǎng)度
t=0:N-1; 
s=sin(2*pi*t/20);           %原始正弦信號(hào)
A=0.5;                      %干擾信號(hào)的幅值
fai=pi/3;                   %干擾信號(hào)的相移
n=A*cos(2*pi*t/10+fai);     %干擾信號(hào)
x=s+n;                      %引入正弦單頻干擾的原始輸入
x1=cos(2*pi*t/10);          %參考輸入1
x2=sin(2*pi*t/10);          %參考輸入2
w1=0.1;
w2=0.1;                     %權(quán)矢量初值
e=zeros(1,N);
y=0;
u=0.05;                  
for i=1:N                   %LMS算法
    y=w1*x1(i)+w2*x2(i);
    e(i)=x(i)-y; 
    w1=w1+u*e(i)*x1(i); 
    w2=w2+u*e(i)*x2(i); 
end
 
subplot(4,1,1);
plot(t,s);
title('原始正弦信號(hào)');
subplot(4,1,2); 
plot(t,x);
title('加入單頻干擾的原始信號(hào)');
subplot(4,1,3);
plot(t,e);
title('自適應(yīng)陷波器輸出');
axis([0 400 -1 1]);
subplot(4,1,4); 
plot(t,s-e);
title('信號(hào)誤差');