contant_v.m

雷达数据处理的重要模型算法之一

%匀速运动
function [X,Z,z]=contant_v(XX,t)
T=1;
f=[1  T   0  0  0   0
   0  1   0  0  0   0
   0  0   0  0  0   0
   0  0   0  1  T   0
   0  0   0  0  1   0
   0  0   0  0  0   0];

X(:,1)=f*XX;
for i=2:t/T
    X(:,i)=f*X(:,i-1);
end
Z(1,:)=X(1,:);%x位置
Z(2,:)=X(2,:);%x速度
Z(3,:)=X(4,:);%y位置
Z(4,:)=X(5,:);%y速度
delta_weiyi=200;     %位移误差
delta_sudu=10;       %速度误差
%加噪
z(1,:)=Z(1,:)+(2*rand(1,t)-1)*delta_weiyi;  %x测量位移
z(2,:)=Z(2,:)+(2*rand(1,t)-1)*delta_sudu;   %x测量速度
z(3,:)=Z(3,:)+(2*rand(1,t)-1)*delta_weiyi;  %y测量位移
z(4,:)=Z(4,:)+(2*rand(1,t)-1)*delta_sudu;   %y测量速度
% Z(1,:)=sqrt( X(1,:).^2+X(4,:).^2 );
% Z(2,:)=atan2(X(4,:),X(1,:));
% 
% delta_r=50;     %径向距离测量误差协方差
% delta_a=0.005;  %方位角测量误差的协方差
% %加噪
% z(1,:)=Z(1,:)+randn(1,t/T)*delta_r;  %模
% z(2,:)=Z(2,:)+randn(1,t/T)*delta_a;  %角