bianfangweijiao.m

五元十字阵边方向的方位角定位精度计算仿真

clear all
close all
%一：轨迹2误差计算公式
b=zeros(1,200);
for i=1:1:200;
    a1=-pi/3+pi*i/300;H=50;L=1000;c=1500;S1=10/1000000;Sc=1;SL=1;
R1=H/cos(a1);
R=sqrt(R1^2+L^2);
d=sqrt(R^2-H^2);
R2=sqrt(1000^2+50^2+(R1*sin(a1)-1000)^2);
R3=sqrt(2000^2+(R1*sin(a1))^2+50^2);
R4=sqrt(1000^2+50^2+(1000+R1*sin(a1))^2);
tao1=(R-R1)/c;
tao2=(R-R2)/c;
tao3=(R-R3)/c;
tao4=(R-R4)/c;
E=[tao1,tao2,tao3,tao4];
a2=atan((tao2-tao4)*[2*R-c*(tao2+tao4)]/((tao1-tao3)*(2*R-c*(tao1+tao3))));
 D=zeros(1,4);
 for k=1:1:4;
  D(k)=(c*(E(k))^2-2*R*c*E(k))*cos(a2-(k-1)*pi/2);
 end
a3=asin(1/(2*R*L)*sum(D));
B1=-1/(1+(tan(a2))^2)*(tao2-tao4)*(2*R-c*(tao2+tao4))*(2*R-2*c*tao1)/((tao1-tao3)*(2*R-c*(tao1+tao3)))^2;
B3=1/(1+(tan(a2))^2)*(tao2-tao4)*(2*R-c*(tao2+tao4))*(2*R-2*c*tao3)/((tao1-tao3)*(2*R-c*(tao1+tao3)))^2;
B2=1/(1+(tan(a2))^2)*(2*R-2*c*tao2)/((tao1-tao3)*(2*R-c*(tao1+tao3)));
B4=-1/(1+(tan(a2))^2)*(2*R-2*c*tao4)/((tao1-tao3)*(2*R-c*(tao1+tao3)));
B5=2/(1+(tan(a2))^2)*(tao2-tao4)*c*(tao2-tao1+tao4-tao3)/(tao1-tao3)/(2*R-c*(tao1+tao3))^2;
B6=2*R*(tao2-tao4)*(tao1-tao2+tao3-tao4)/(1+(tan(a2))^2)/(tao1-tao3)/(2*R-c*(tao1+tao3))^2;
shiyan=S1*sqrt(B1^2+B2^2+B3^2+B4^2);
shenshu=B6*Sc;
chicun=B5*SL;
b(1,i)=chicun;
end
n=[1:200];
stem(n,b)
%shensu=B6*Sc
%chicun=B5*SL