GPS网平差系列之求误差椭圆代码

GPS网平差系列之求误差椭圆代码function [E,F ,max,kkk] = EF(Qx1x1,sd,dd,ed,uw0)

%UNTITLED Summary of this function goes here

% Detailed explanation goes here

global E F max kkk;

Q=diag(Qx1x1);

Q=reshape(Q',3,dd);

Q=Q';

QXX=Q(:,1)

QYY=Q(:,2)

QXX=diag(QXX);

QYY=diag(QYY);

QXY=zeros(1,dd);

m=1;

for i=2:3:(3*dd-1)

j=i-1;

QXY(m)=Qx1x1(i,j);

m=m+1;

end

QXY=diag(QXY);

K=sqrt((QXX-QYY)*(QXX-QYY)+4*QXY*QXY)

QEE=0.5*(QXX+QYY+K);

QFF=0.5*(QXX+QYY-K);

E=uw0*sqrt(QEE);

F=uw0*sqrt(QFF);

P=E*E+F*F;

P=diag(P);

P=[P;zeros(ed,1)];

E=diag(E);

F=diag(F);

E=[E;zeros(ed,1)]

F=[F;zeros(ed,1)]

%P=E'*E+F'*F%%%%%%注意是把P控制为一行一列max=P(1);

kkk=1;

for i=1:sd

if(max

max=P(i);

kkk=i;

end

end

max=P(kkk);

end