摄影测量实作业.doc

摄影测量实习作业 —. 后方交会解算程序。 原程序： A=input(请输入地面点坐标:) B=input(请输入影像坐标点:)/1000 f=input(请输入主距:)/1000 C=input(请输入像主点坐标初始值:) E=input(请输入外方位角初始值:) i=size(B,1); B=[B;B(1,:)]; A=[A;A(1,:)]; Xs=0; Ys=0; for j=1:i m=sqrt(((A(j,1)-A(j+1,1)).^2+(A(j,2)-A(j+1,2)).^2)/((B(j,1)-B(j+1,1)).^2+(B(j,2)-B(，2)).^2))/(i-1); Xs=Xs+A(j,1)/i; Ys=Ys+A(j,2)/i; end Zs=m*f; for j=1:1000 R(1,1)=cos(E(1))*cos(E(3))-sin(E(1))*sin(E(2))*sin(E(3)); R(1,2)=-cos(E(1))*sin(E(3))-sin(E(1))*sin(E(2))*cos(E(3)); R(1,3)=-sin(E(1))*cos(E(2)); R(2,1)=cos(E(2))*sin(E(3)); R(2,2)=cos(E(2))*cos(E(3)); R(2,3)=-sin(E(2)); R(3,1)=sin(E(1))*cos(E(3))+cos(E(1))*sin(E(2))*sin(E(3)); R(3,2)=-sin(E(1))*sin(E(3))+cos(E(1))*sin(E(2))*cos(E(3)); R(3,3)=cos(E(1))*cos(E(2)); for n=1:i Xp(n)=R(1,1)*(A(n,1)-Xs)+R(2,1)*(A(n,2)-Ys)+R(3,1)*(A(n,3)-Zs); Yp(n)=R(1,2)*(A(n,1)-Xs)+R(2,2)*(A(n,2)-Ys)+R(3,2)*(A(n,3)-Zs); Zp(n)=R(1,3)*(A(n,1)-Xs)+R(2,3)*(A(n,2)-Ys)+R(3,3)*(A(n,3)-Zs); xc(n)=-f*Xp(n)/Zp(n); yc(n)=-f*Yp(n)/Zp(n); D(2*n-1,1)=(R(1,1)*f+R(1,3)*xc(n))/Zp(n); D(2*n-1,2)=(R(2,1)*f+R(2,3)*xc(n))/Zp(n); D(2*n-1,3)=(R(3,1)*f+R(3,3)*xc(n))/Zp(n); D(2*n,1)=(R(1,2)*f+R(1,3)*yc(n))/Zp(n); D(2*n,2)=(R(2,2)*f+R(2,3)*yc(n))/Zp(n); D(2*n,3)=(R(3,2)*f+R(3,3)*yc(n))/Zp(n); D(2*n-1,4)=yc(n)*sin(E(2))-(xc(n)/f*(xc(n)*cos(E(3))-yc(n)*sin(E(3)))+f*cos(E(3)))*cos(E(2)); D(2*n-1,5)=-f*sin(E(3))-xc(n)*(xc(n)*sin(E(3))+yc(n)*cos(E(3)))/f; D(2*n-1,6)=yc(n); D(2*n,4)=-xc(n)*sin(E(2))- (yc(n)/f*(xc(n)*cos(E(3))-yc(n)*sin(E(3)))-f*sin(E(3)))*cos(E(2)); D(2*n,5)= -f*cos(E(3))-yc(n)*(xc(n)*sin(E(3))+yc(n)*cos(E(3)))/f; D(2*n,6)=-xc(n); L(2*n-1,1)=Y(n,1)-xc(n); L(2*n,1)=Y(n,2)-yc(n); end X=inv(D*D)*D*L; Xs=Xs+X(1); Ys=Ys+X(2); Zs=Zs+X(3); E(1)=E(1)+X(4); E(2)=E(2)+X(5); E(3)=E(3)+X(6); M=max(abs(X)); if M=0.001 Xs Ys Zs R break; end end 二．运行实例（课本p-44 习题24） 27.已知四队点的影像坐标和地点坐标如下： 影像坐标 地面坐标 x(mm) y(mm0 X(mm) Y(mm) Z(mm) 1 —86.15 —68.99 36589.41 25273.32 2195.17 2 —53.40 82.21 37631.08 31324.51 728.6