zhuanwan.m

转弯运动模型

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
w=[0.05,-0.05,0.1,-0.04,-0.06,0.08,-0.08];
T=0.5;
x(1,1)=3000;
x(2,1)=400;
x(3,1)=4000;
x(4,1)=300;

for j=1:length(w)
    A=[1,sin(w(j)*T)/w(j),0,(cos(w(j)*T)-1)/w(j);0,cos(w(j)*T),0,-sin(w(j)*T);0,-(cos(w(j)*T)-1)/w(j),1,sin(w(j)*T)/w(j);0 ,sin(w(j)*T),0,cos(w(j)*T)];
    for i=(50*(j-1)+1):(50*j)
        a(i)=120*normrnd1(i);
        b(i)=160*normrnd1(i);
       x(:,i+1)=A*x(:,i);
       X(:,i+1)=A*x(:,i)+[a(i),a(i),b(i),b(i)]';
    end
end
plot(x(1,1),x(3,1),'r^',x(1,:),x(3,:),'r-',X(1,:),X(3,:),'g*')
title('转弯运动')
hold on
legend('起始点','理论曲线','方差为Q1=120;Q2=160的观测曲线');
xlabel('X坐标轴');
ylabel('Y坐标轴');
grid on