www.pudn.com > pdaf-demo.rar > data.m


%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% 
%generate data of target trajectory 
%Writed by Liangqun Li  
%Date:2006.4.21 
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% 
clear all 
n=50;                                                    %采样次数 
T=1;                                                     %T为采样间隔 
MC_number=10;                                            %monte carlos run times 
target_position=[1.5 0.5 1.5  0.1];                      %目标的起始位置和速度                    
data_measurement1=zeros(2,n);                            %data_measurement观测值矩阵,data_measurement1实际位置矩阵     
Q=[0.0004 0;0 0.0004]; 
Qdelta=sqrt(Q(1,1)); 
data_measurement1(:,1,1)=target_position(1); 
data_measurement1(:,2,1)=target_position(3); 
for i=2:n 
        if i~=1 
            data_measurement1(1,i)=data_measurement1(1,1)+T*(i-1)*target_position(2)+rand(1)*Qdelta;            
            data_measurement1(2,i)=data_measurement1(2,1)+T*(i-1)*target_position(4)+rand(1)*Qdelta;   %实际位置 不考虑速度 
        end 
end 
plot(data_measurement1(1,:),data_measurement1(2,:),'-'); 
axis([0 30 1 7])