addmove.m

来自「目标跟踪的仿真对于产生量测、噪声和杂波以及目标运动各种模型的matlab代码」· M 代码 · 共 23 行

function AddMoveTrack=AddMove(InitPosition,InitVelocity,Acceleration,AccBeginTime,AccEndTime,N,ts)

AddMoveTrack=zeros(4,N);
AddMoveTrack(1,1)=InitPosition(1,1);
AddMoveTrack(2,1)=InitVelocity(1,1);
AddMoveTrack(3,1)=InitPosition(2,1);
AddMoveTrack(4,1)=InitVelocity(2,1);
i=1;
while i<AccBeginTime
    AddMoveTrack(:,i+1)=AddMoveTrack(:,i)+ts*[InitVelocity(1,1) 0 InitVelocity(2,1) 0]';
    i=i+1;
end
while (i>=AccBeginTime)&(i<AccEndTime)
    AddMoveTrack(2,i+1)=AddMoveTrack(2,i)+ts*Acceleration(1,1);
    AddMoveTrack(4,i+1)=AddMoveTrack(4,i)+ts*Acceleration(2,1);
    AddMoveTrack(1,i+1)=AddMoveTrack(1,i)+AddMoveTrack(2,i)*ts+0.5*ts.^2*Acceleration(1,1);
    AddMoveTrack(3,i+1)=AddMoveTrack(3,i)+AddMoveTrack(4,i)*ts+0.5*ts.^2*Acceleration(2,1);    i=i+1;
end
while (i>=AccEndTime)&(i<N)
    AddMoveTrack(:,i+1)=AddMoveTrack(:,i)+ts*[AddMoveTrack(2,AccEndTime) 0 AddMoveTrack(4,AccEndTime) 0]';
    i=i+1;
end