时差定位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;