track_begin.asv

IMM滤波的 matlab程序

function [track1,track2,tracknum,framedata1,framedata2]=Track_Begin(framedata1,num1,framedata2,num2,Start_Gate)
%两点起始


tracknum=0;
for i=1:num1
    for j=1:num2
        if framedata2(j,5)==0
            distants=abs(framedata1(i,2)-framedata2(j,2));
            if distants<=Start_Gate  %找到航迹
                framedata1(i,5)=1;
                framedata2(j,5)=1;
                tracknum=tracknum+1;
                track1(tracknum,:)=[tracknum,framedata(i,2,1),framedata(i,3,1),framedata(i,4,1),framedata(i,2,),framedata(i,3),framedata(i,4)];
                track2(tracknum,:)=[tracknum,framedata(j,2),framedata(j,3),framedata(j,4),framedata(j,2),framedata(j,3),framedata(j,4)];
            end
        end
    end
end
track(:,:,1)=track1;
track(:,:,2)=track2;