資源簡介
時差定位算法,計算GDOP并得到精度,繪出GDOP圖。可以計算星型、菱形、平行型站點分布。
代碼片段和文件信息
clc;
clear;
x2=-12.99;?x3=12.99;?xt=0;?x1=0;%%%星型d=15km
?y2=7.5;?y3=7.5;?yt=-15;?y1=0;
?z2=0.01;?z3=0;?zt=0.01;??z1=0.01;
%?
%?x1=-25.98;?x2=25.98;?x3=0;?xt=0;%%%星型d=30km
%?y1=15;?y2=15;?y3=-30;?yt=0;
%?z1=0.2;?z2=0.2;?z3=0.2;??zt=0.25;
%?xt=-12.99;?x2=12.99;?x3=0;?x1=0;%%%菱形型d=15km
%?yt=7.5;?y2=7.5;?y3=15;?y1=0;
%?zt=0;?z2=0;?z3=0;??z1=0.1;
%?x1=-25.98;?x2=25.98;?x3=0;?xt=0;%%%菱形型d=30km
%?y1=15;?y2=15;?y3=30;?yt=0;
%?z1=0;?z2=0;?z3=0;??zt=0.1;
%?x1=-10.6;?x2=10.6;?x3=21.2;?xt=0;%%%平行角型形型d=15km
%?y1=10.6;?y2=10.6;?y3=0;?yt=0;
%?z1=0;?z2=0;?z3=0;??zt=0.1;
%?x1=-21.2;?x2=21.2;?x3=42.4;?xt=0;%%%平行型形型d=30km
%?y1=21.2;?y2=21.2;?y3=0;?yt=0;
%?z1=0;?z2=0;?z3=0;??zt=0.1;
%?
%?x1=-30;?x2=0;?x3=30;?xt=0;%%%倒三形型d=30km
%?y1=30;?y2=30;?y3=30;?yt=0;
%?z1=0;?z2=0;?z3=0;??zt=0.1;
z=15;
y=-200:1:200;x=-200:1:200;
%?
for?i=1:401
????for?j=1:401
%?????????for?i=-70:70
%?????for?j=-70:70
????????m=x(i);
????????n=y(j);
????????r1=((m-x1).^2+(n-y1).^2+(z-z1).^2).^(1/2);
????????r2=((m-x2).^2+(n-y2).^2+(z-z2).^2).^(1/2);
????????r3=((m-x3).^2+(n-y3).^2+(z-z3).^2).^(1/2);
????????%r4=((m-x4).^2+(n-y4).^2+(z-z4).^2).^(1/2);
????????rt=((m-xt).^2+(n-yt).^2+(z-zt).^2).^(1/2);
????????c11=(m-x1)/r1;c21=(m-x2)/r2;c31=(m-x3)/r3;ct1=(m-xt)/rt;
????????c12=(n-y1)/r1;c22=(n-y2)/r2;c32=(n-y3)/r3;ct2=(n-yt)/rt;
????????c13=(z-z1)/r1;c23=(z-z2)/r2;c33=(z-z3)/r3;ct3=(z-zt)/rt;
c=[(-ct1+c11)?(-ct2+c12)?(-ct3+c13);(-ct1+c21)?(-ct2+c22)?(-ct3+c23);(-ct1+c31)?(-ct2+c32)?(-ct3+c33)];
????????b=inv(c‘*c)*(c‘);
????????b11=b(1);
????????b12=b(4);
????????b13=b(7);
????????b21=b(2);
????????b22=b(5);
????????b23=b(8);
????????b31=b(3);
????????b32=b(6);
????????b33=b(9);
%?????????b14=b(10);
%?????????b24=b(11);
%?????????b34=b(12);
sigmap=0.5;
- 上一篇:matlab模型_PR控制策略的PWM整流器
- 下一篇:圓柱體磁異常正演
評論
共有 條評論