m12_4.m

MATLAB控制系统仿真与实例详解（附书光盘）

%ML
clear              
a(1)=1;b(1)=0;c(1)=1;d(1)=0;u(1)=d(1);z(1)=0;z(2)=0; %初始化
for i=2:1200          %产生m序列u(i)         
    a(i)=xor(c(i-1),d(i-1));
    b(i)=a(i-1);
    c(i)=b(i-1);
    d(i)=c(i-1);
    u(i)=d(i);
end
u; 
v=randn(1200,1); %产生正态分布随机数
V=0;   %计算噪声方差
for i=1:1200
    V=V+v(i)*v(i);
end
V1=V/1200;   
for k=3:1200      %根据v和u计算z
 z(k)=1.2*z(k-1)-0.6*z(k-2)+u(k-1)+0.5*u(k-2)+v(k)-v(k-1)+0.2*v(k-2);
end

o1=0.001*ones(6,1);p0=eye(6,6);         %赋初值
 zf(1)=0.1;zf(2)=0.1;vf(2)=0.1;vf(1)=0.1;uf(2)=0.1;uf(1)=0.1;
   %迭代计算参数值和误差值
for k=3:1200
      h=[-z(k-1);-z(k-2);u(k-1);u(k-2);v(k-1);v(k-2)];
      hf=h;
     K=p0*hf*inv(hf'*p0*hf+1); 
     p=[eye(6,6)-K*hf']*p0; 
     v(k)=z(k)-h'*o1;
     o=o1+K*v(k) ;
       p0=p;
    o1=o;
    a1(k)=o(1);
    a2(k)=o(2);
    b1(k)=o(3);
    b2(k)=o(4);
    d1(k)=o(5);
    d2(k)=o(6);
    e1(k)=abs(a1(k)+1.2);
    e2(k)=abs(a2(k)-0.6);
    e3(k)=abs(b1(k)-1.0);
    e4(k)=abs(b2(k)-0.5);
    e5(k)=abs(d1(k)+1.0);
    e6(k)=abs(d2(k)-0.2);
     zf(k)=z(k)-d1(k)*zf(k-1)-d2(k)*zf(k-2);

     uf(k)=u(k)-d1(k)*uf(k-1)-d2(k)*uf(k-2);   
    
     vf(k)=v(k)-d1(k)*vf(k-1)-d2(k)*vf(k-2);  
   hf=[-zf(k-1);-zf(k-2);uf(k-1);uf(k-2);vf(k-1);vf(k-2)];    
 end 
 o1  
 V1