deletetrack.asv

IMM滤波的 matlab程序

function  [SaveTrack,track,deletetracknum,P_jpda_cvk_1r,MUr1,P_jpda_cvk_1theta,MUtheta1,P_jpda_cvk_1q,MUq1]=DeleteTrack(track,SaveTrack,j,spt,tracknum,deletetracknum,P_jpda_cvk_1r,MUr1,P_jpda_cvk_1theta,MUtheta1,P_jpda_cvk_1q,MUq1);
%此函数用于删除连续两次没有量测点落入门限内的航迹i，并把删除的航迹保存到SaveTrack中，以便后期进行作图

deletetracknum=deletetracknum+1;
for i=1:spt
    SaveTrack(deletetracknum,:,i)=track(j,:,i);
end

% for i=1:spt
%     for j=j:tracknum
%     track(j,:,i)=track(j+1,:,i);
%     end
% end
if j<tracknum
    for j=j:tracknum-1
        P_jpda_cvk_1r(:,:,:,j+1)
        track(j,:,:)=track(j+1,:,:);
        P_jpda_cvk_1r(:,:,:,j)=P_jpda_cvk_1r(:,:,:,j+1);
        MUr1(:,:,j)=MUr1(:,:,j+1);
        P_jpda_cvk_1theta(:,:,:,j)=P_jpda_cvk_1theta(:,:,:,j+1);
        MUtheta1(:,:,j)=MUtheta1(:,:,j+1);   
        P_jpda_cvk_1q(:,:,:,j)=P_jpda_cvk_1q(:,:,:,j+1);
    MUq1(:,:,j)=MUq1(:,:,j+1);
end