test_riv.m

来自「系统辨识的最小二乘递推算法、辅助变量法、增广最小二乘法及偏差补偿法的matlab」· M 代码 · 共 38 行

load input data_in;
load output data_out;

data_sum = size(data_out);
U0 = data_in(2,1:data_sum(2));
Z0 = data_out(2,1:data_sum(2));

m(1)=input('order of A(z)');
m(2)=input('order of B(z)');
n = max(m) + m(2);

Len=size(Z0);  
L = Len(2) - n;
z = 0;
P = 10e6*eye(m(1)+m(2));
sita = 0.001*ones(m(1)+m(2),1);
h = zeros(m(1)+m(2),1);
MatixI = eye(m(1)+m(2));

for i=1:L
    for j=1:m(1)
        h(j,1) = -Z0(n+i-j);
    end;
    for j=1:m(2)
        h(j+m(1),1) = U0(n+i-j);
    end;
    h_s = h;
    for j=1:m(1)
        h_s(j,1) = -U0(n+i-m(2)-j);
    end;
    
    z = Z0(n+i);
    K = P*h_s/(h'*P*h_s+1);
    sita = sita + K*(z - h'*sita);
    P = (MatixI - K*h') * P;
end

sita