jerkmove.m

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

function JerkMoveTrack=JerkMove(InitPosition,InitVelocity,JerkVelocity,JerkTime,N,ts)

JerkMoveTrack=zeros(4,N);
JerkMoveTrack(1,1)=InitPosition(1,1);
JerkMoveTrack(2,1)=InitVelocity(1,1);
JerkMoveTrack(3,1)=InitPosition(2,1);
JerkMoveTrack(4,1)=InitVelocity(2,1);
for i=2:1:JerkTime-1
    JerkMoveTrack(:,i)=JerkMoveTrack(:,i-1)+ts*[InitVelocity(1,1) 0 InitVelocity(2,1) 0]';
end

for i=JerkTime:1:N
    JerkMoveTrack(:,i)=JerkMoveTrack(:,i-1)+ts*[InitVelocity(1,1)+JerkVelocity(1,1) 0 InitVelocity(2,1)+JerkVelocity(2,1) 0]';
end