householder.m

一个二阶中心插值滤波器（DDF2）的目标跟踪仿真实例。

%  一个matlab的（Householder变换）：

function [A,d]=HouseholderQR(A)
[m,n]=size(A);
I=diag(ones(m,1));
d=zeros(n,1);
for j=1:n
[v,b]=Householder(A(j:m,j));
A(j:m,j:n)=(I(j:m,j:m)-b*v*v')*A(j:m,j:n);
d(j)=b;
if j<m
A(j+1:m,j)=v(2:m-j+1);
end;
end;

function [v,b]=Householder(x)
if size(x,1)==1
x=x';
end
n=length(x);
ninf=max(abs(x));
if ninf==0
v=x;
b=0;
return;
end
x=x/ninf;
n2=dot(x(2:n),x(2:n));
v=x;
v(1)=1;
if n2==0
b=0;
else
a=sqrt(x(1)*x(1)+n2);
if x(1)<=0
v(1)=x(1)-a;
else
v(1)=-n2/(x(1)+a);
end
b=2*v(1)*v(1)/(n2+v(1)*v(1));
v=v/v(1);
end
return