2018研究生数学建模E题答案

clc; clear; point=xlsread('C:\Users\Shawn\Desktop\dalao\points.xls','B2:D21'); Radar1_Falsetrack_planePoint_x=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar1_Falsetrack_planePoint.xls','B2:U2'); Radar1_Falsetrack_planePoint_y=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar1_Falsetrack_planePoint.xls','B3:U3'); Radar1_Falsetrack_planePoint_z=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar1_Falsetrack_planePoint.xls','B4:U4'); Radar2_Falsetrack_planePoint_x_1=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar2_Falsetrack_planePoint.xls','B2:U2'); Radar2_Falsetrack_planePoint_y_1=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar2_Falsetrack_planePoint.xls','B3:U3'); Radar2_Falsetrack_planePoint_z_1=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar2_Falsetrack_planePoint.xls','B4:U4'); Radar2_Falsetrack_planePoint_x_2=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar2_Falsetrack_planePoint.xls','B2:U2'); Radar2_Falsetrack_planePoint_y_2=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar2_Falsetrack_planePoint.xls','B3:U3'); Radar2_Falsetrack_planePoint_z_2=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar2_Falsetrack_planePoint.xls','B4:U4'); Radar3_Falsetrack_planePoint_x=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar3_Falsetrack_planePoint.xls','B2:U2'); Radar3_Falsetrack_planePoint_y=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar3_Falsetrack_planePoint.xls','B3:U3'); Radar3_Falsetrack_planePoint_z=xlsread('C:\Users\Shawn\Desktop\jianmo\Radar3_Falsetrack_planePoint.xls','B4:U4'); %%%%%%%%%%%%%%%%%%%%%%%%%%%%%初始化 Rx=[80000,30000,55000,105000,130000]; Ry=[0,60000,110000,110000,60000]; Rz=0; Falsetrack_planeResultPoint_2=zeros(20,3); Falsetrack_planeResultPoint_3=zeros(20,3); Falsetrack_planeResultPoint_4=zeros(20,3); Radar=zeros(5,2); Ky=zeros(1,20); by=zeros(1,20); Kz=zeros(1,20); bz=zeros(1,20); Point_xx=zeros(1,20); Point_yy=zeros(1,20); Point_zz=zeros(1,20); ky_3=zeros(1,20); by_3=zeros(1,20); kz_3=zeros(1,20); bz_3=zeros(1,20); Distance=zeros(1,20); Point_xxx=zeros(1,20); Point_yyy=zeros(1,20); Point_zzz=zeros(1,20); %%%%%%%%%%%%%%%%%%%%%%%%%%%%%初始化 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%解决飞机假轨迹 for i=1:5 Radar(i,1:2)=[Rx(i),Ry(i)]; end for j=2:4 for i=1:20 Ky(i)=(point(i,2)-Radar(j,2))/(point(i,1)-Radar(j,1)); by(i)=Radar(j,2)-Radar(j,1)*Ky(i); Kz(i)=(point(i,3))/(point(i,1)-Radar(j,1)); bz(i)=0-Radar(j,1)*Kz(i); if(i==19) ky_19=(point(i,2)-Radar(1,2))/(point(i,1)-Radar(1,1)); by_19=Radar(1,2)-Radar(1,1)*ky_19; kz_19=(point(i,3))/(point(i,1)-Radar(1,1)); bz_19=0-Radar(1,1)* kz_19; Point_zz(i)=2493; Point_xx(i)=(Point_zz(i)- bz_19)/ kz_19; Point_yy(i)= Point_xx(i)*ky_19+by_19; end if(i==20) syms x; px=x; py=Ky(i)*px+by(i); pz=Kz(i)*px+bz(i); ky_20=(py-Radar(1,2))/(px-Radar(1,1)); by_20=Radar(1,2)-Radar(1,1)*ky_20; kz_20=pz/(px-Radar(1,1)); bz_20=0-Radar(1,1)*kz_20; qz=2487; qx=(qz-bz_20)/kz_20; qy=qx*ky_20+by_20; P=[px py pz]; Q=[qx,qy,qz]; T=[Point_xx(i-1),Point_yy(i-1),Point_zz(i-1)]; d=norm(Q-T); px= solve(subs(d,px)==370,px); px=double(px); if(j==2&&abs(px(1)-point(i-1))<=abs(px(2)-point(i-1))) Falsetrack_planeResultPoint_2(i,1)=px(1); else if(j==3&&abs(px(1)-point(i-1))<=abs(px(2)-point(i-1))) Falsetrack_planeResultPoint_3(i,1)=px(1); else if(j==4&&abs(px(1)-point(i-1))<=abs(px(2)-point(i-1))) Falsetrack_planeResultPoint_4(i,1)=px(1); else if(abs(px(1)-point(i-1))>abs(px(2)-point(i-1))&&j==2) Falsetrack_planeResultPoint_2(i,1)=px(2); else if(abs(px(1)-point(i-1))>abs(px(2)-point(i-1))&&j==3) Falsetrack_planeResultPoint_3(i,1)=px(2); else if(abs(px(1)-point(i-1))>abs(px(2)-point(i-1))&&j==4) Falsetrack_planeResultPoint_4(i,1)=px(2); end end end end end end px=Falsetrack_planeResultPoint_2(i,1); py=Ky(i)*px+by(i); pz=Kz(i)*px+bz(i); ky_20=(py-Radar(1,2))/(px-Radar(1,1)); by_20=Radar(1,2)-Radar(1,1)*ky_20; kz_20=pz/(px-Radar(1,1)); bz_20=0-Radar(1,1)*kz_20; qz=2487; qx=(qz-bz_20)/kz_20; qy=qx*ky_20+by_20; if(j==2) Falsetrack_planeResultPoint_2(i,2)=Ky(i)*px+by(i); Falsetrack_planeResultPoint_2(i,3)=Kz(i)*px+bz(i); else if(j==3) Falsetrack_planeResultPoint_3(i,2)=Ky(i)*px+by(i); Falsetrack_planeResultPoint_3(i,3)=Kz(i)*px+bz(i); else if(j==4) Falsetrack_planeResultPoint_4(i,2)=Ky(i)*px+by(i); Falsetrack_planeResultPoint_4(i,3)=Kz(i)*px+bz(i); end end end Point_xx(i)=qx; Point_xx(i)=qy; Point_zz(i)=qz; ky_20=(point(i,2)-Radar(1,2))/(point(i,1)-Radar(1,1)); by_20=Radar(1,2)-Radar(1,1)*ky_20; kz_20=(point(i,3))/(point(i,1)-Radar(1,1)); bz_20=0-Radar(1,1)*kz_20; Point_zz(i)=2500; Point_xx(i)=(Point_zz(i)-bz_20)/kz_20; Point_yy(i)=Point_xx(i)*ky_20+by_20; for k=19:-1:1 syms x; px=x; py=Ky(k)*px+by(k); pz=Kz(k)*px+bz(k); ky_1=(py-Radar(1,2))/(px-Radar(1,1)); by_1=Radar(1,2)-Radar(1,1)*ky_1; kz_1=pz/(px-Radar(1,1)); bbz=0-Radar(1,1)*kz_1; qz=2500; qx=(qz-bbz)/kz_1; qy=qx*ky_1+by_1; P=[px py pz]; Q=[qx,qy,qz]; T=[Point_xx(k+1),Point_yy(k+1),Point_zz(k+1)]; d=norm(Q-T); px= solve(subs(d,px)==434,px); px=double(px); if (abs(px(1)-point(k+1))<=abs(px(2)-point(k+1))&&j==2) Falsetrack_planeResultPoint_2(k,1)=px(1); else if(abs(px(1)-point(k+1))<=abs(px(2)-point(k+1))&&j==3) Falsetrack_planeResultPoint_3(k,1)=px(1); else if(abs(px(1)-point(k+1))<=abs(px(2)-point(k+1))&&j==4) Falsetrack_planeResultPoint_4(k,1)=px(1); else if (abs(px(1)-point(k+1))>abs(px(2)-point(k+1))&&j==2) Falsetrack_planeResultPoint_2(k,1)=px(2); else if(abs(px(1)-point(k+1))>abs(px(2)-point(k+1))&&j==3) Falsetrack_planeResultPoint_3(k,1)=px(2); else if(abs(px(1)-point(k+1))>abs(px(2)-point(k+1))&&j==4) Falsetrack_planeResultPoint_4(k,1)=px(2); end end end end end end if(j==2) px=Falsetrack_planeResultPoint_2(k,1); else if(j==3) px=Falsetrack_planeResultPoint_3(k,1); else if(j==4) px=Falsetrack_planeResultPoint_4(k,1); end end