track_begin.m

来自「IMM滤波的 matlab程序」· M 代码 · 共 24 行

function [track,tracknum]=Track_Begin(track,framedata1,framedata2,num1,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,framedata1(i,2),framedata1(i,3),framedata1(i,4),framedata1(i,2),framedata1(i,3),framedata1(i,4)];
                track2(tracknum,:)=[tracknum,framedata2(j,2),framedata2(j,3),framedata2(j,4),framedata2(j,2),framedata2(j,3),framedata2(j,4)];
                track(tracknum,:,1)=track1(tracknum,:);
                track(tracknum,:,2)=track2(tracknum,:);
            end
        end
    end
end
% track(:,:,1)=track1;
% track(:,:,2)=track2;