nodgen.m

非线性跟踪中贝叶斯滤波算法

function Nod = NodGen( L,W,M,u )
%生成节点分布
l=((L-15)*(W-15)/M)^0.5;
i=1;
j=1;
for m=1:M
    if( (15+(i-1)*l)<=(L-15) )
        Nod{m}(1)=20+(i-1)*l+u*randn;
        Nod{m}(2)=20+(j-1)*l+u*randn;
        i=i+1;
        j=j;
    else
        i=1;
        j=j+1;
        Nod{m}(1)=20+(i-1)*l+u*randn;
        Nod{m}(2)=20+(j-1)*l+u*randn;   
        i=i+1;
        j=j;
    end
    x(m)=Nod{m}(1);
    y(m)=Nod{m}(2);
end
% for m=1:M
%     Nod{m}(1)=L*rand;
%     Nod{m}(2)=W*rand;
%     x(m)=Nod{m}(1);
%     y(m)=Nod{m}(2);
% end
% figure,plot(x,y,'.');
% axis([0 L 0 W]);