平均间隙法matlab代码

%参数QX为两次高程之差的权阵，DH为两次高程之差（列向量），M=（v1‘*P1*v1+v2‘*P1*v2）/（f1+f2）r=f1+f2;
function[flagtgfF]=pjjxf（QXDHMr）
flag=0
d0=size（DH）;
d=d0（1）;
tg0=1:d;
tg=tg0‘;
tpQX=QX;
tpDH=DH;
ff=rank（tpQX）;
N0=DH‘*pinv（QX）*DH;
N=N0/ff;
F=N/M
finv（0.95ff6） 
while F>finv（0.95ffr）    
     for i=1:d-flag; 
       J=eye（d）;%构造一个行变换的简单矩阵
       J（ii）=0;
       J（d-flagd-flag）=0;
       J（id-flag）=1;
       J（d-flagi）=1;
       tempQX=J*tpQX*J‘;
       tempDH=J*tpDH;
       tempPX=pinv（tempQX）;
       PMF=tempPX（d-flag:d1:d-flag-1）;
       PMM=tempPX（d-f