%RLS算法，選用電力系統諧波信號作為輸入信號。參考書目：現代數字信號處理，皇甫堪等，電子工業出版社。126頁
clear all;close all;
f1=50;ts=1/1000;n=1:256;N=256;
d=2*sin(2*pi*f1*n*ts)+1.4*sin(2*pi*f1*7*n*ts);
y1=2*sin(2*pi*f1*n*ts);
x=sin(2*pi*f1*n*ts+pi/2);M=4;lamda=0.99;
W(:,1)=zeros(1,M);
P=35*eye(M);
for n=1:N
    for m=1:M
        if n<=m-1
            a(m)=0;
        else
            a(m)=x(n-m+1);
        end
    end
X(:,n)=a;
K(:,n)=P*X(:,n)/(lamda+X(:,n)'*P*X(:,n));
e(n)=d(n)-X(:,n)'*W(:,n);

y(n)=X(:,n)'*W(:,n);
W(:,n+1)=W(:,n)+K(:,n)*e(n);
P=(P-K(:,n)*X(:,n)'*P)/lamda;
end
plot(y)
sum(abs(y-y1).^2);