wf2xf.asv

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

function [x,y]=wf2xf(R,X,Y,Z,XS0,YS0,ZS0)
    a1=R(1,1);
    a2=R(1,2);
    a3=R(1,3);
    b1=R(2,1);
    b2=R(2,2);
    b3=R(2,3);
    c1=R(3,1);
    c2=R(3,2);
    c3=R(3,3);

    I=a1*(X-XS0)+b1*(Y-YS0)+c1*(Z-ZS0);
    II=a2*(X-XS0)+b2*(Y-YS0)+c2*(Z-ZS0);
    III=a3*(X-XS0)+b3*(Y-YS0)+c3*(Z-ZS0);

    x=-f*I./III;     %单位为毫米
    y=-f*II./III;     %单位为毫