zhuan.m

来自「转弯运动模型」· M 代码 · 共 53 行

clear

%二维的作水平圆周运动的空中或水下目标的航迹示意图：


a0=19;
C=51329;
x1(1)=47169; 
M=2^16;  
for i=1:5999
	  x1(i+1)=mod(x1(i)*a0+C,M);
end
for i=1:6000
	  fakerand(i)=x1(i)/M;
end
for i=1:500
	  normrnd1(i)=0;
	  for j=(12*(i-1)+1):(12*i)
		  normrnd1(i)=normrnd1(i)+fakerand(j);
      end
	  normrnd1(i)=normrnd1(i)-6;
end


Q1=20;
Q2=30;

x0=3000;
y0=4000;

v=300;

w=-0.05;
t0=0;
t=[1:500]+t0;


for i=1:10
    x(i)=x0+v/w*cos(w*(t(i)-t0))+Q1*normrnd1(i);
    y(i)=y0+v/w*sin(w*(t(i)-t0))+Q2*normrnd1(i);
end
for i=1:10
    X(i)=x0+v/w*cos(w*(t(i)-t0));
    Y(i)=y0+v/w*sin(w*(t(i)-t0));
end
plot(x,y,'g-',X,Y,'r:')
hold on
legend('方差为Q1=20;Q2=30的观测曲线','理论曲线');
title('水平圆周运动轨迹示意图');
 xlabel('X坐标轴');
ylabel('Y坐标轴');
grid on