norcoe.m

摄影测量学中单像空间后方交会程序

function A=NorCoe(f,H,xs,ys)
%这是个计算法方程系数矩阵A的函数;

       for i=1:4
    
            a11=-f/H;
            a12=0;
            a13=-xs(i,1)/H;
            a14=-f*(1+xs(i,1)^2/f^2);
            a15=-xs(i,1)*ys(i,1)/f;
            a16=ys(i,1);
            a21=0;
            a22=-f/H;
            a23=-ys(i,1)/H;
            a24=-xs(i,1)*ys(i,1)/f;
            a25=-f*(1+ys(i,1)^2/f^2);
            a26=-xs(i,1);
            if i==1
                A1=[a11 a12 a13 a14 a15 a16;a21 a22 a23 a24 a25 a26];
               
            elseif(i==2)
                A2=[a11 a12 a13 a14 a15 a16;a21 a22 a23 a24 a25 a26];
              
            elseif(i==3)
                A3=[a11 a12 a13 a14 a15 a16;a21 a22 a23 a24 a25 a26];
               
            elseif(i==4)
                A4=[a11 a12 a13 a14 a15 a16;a21 a22 a23 a24 a25 a26];
              
            end
        end
    A=[A1;A2;A3;A4];