摄影测量——后方交会(matlab).doc

3.用matlab编程结果function XS,YS,ZS,p,w,k=hfjhx_o=-0.08615;-0.06899;-0.05340;0.08211;-0.01478;-0.07663;0.01064;0.06443;X=36589.641,25273.32,2195.17;37631.08,31324.51,728.69; 39100.97,24934.98,2386.50;40426.54,30319.81,757.31;f=0.15324;m=40000;XS=38437;YS=27963.155;ZS=f*m+1516.9175;p=0;w=0;k=0;R=zeros(3,3);num=1;dx=zeros(6,1);while num=1|abs(dx(4,1)*206225)6|abs(dx(5,1)*206225)6|abs(dx(6,1)*206265)6;R(1,1)=cos(p)*cos(k)-sin(p)*sin(w)*sin(k);R(1,2)=-cos(p)*cos(k)-sin(p)*sin(w)*sin(k);R(1,3)=-sin(p)*cos(w);R(2,1)=cos(w)*sin(k);R(2,2)=cos(w)*cos(k);R(2,3)=-sin(w);R(3,1)=sin(p)*cos(k)+cos(p)*sin(w)*sin(k);R(3,2)=-sin(p)*sin(k)+cos(p)*sin(w)*cos(k);R(3,3)=cos(p)*cos(w);x_s=zeros(8,1);x_s(1,1)=-f*(R(1,1)*(X(1,1)-XS)+R(2,1)*(X(1,2)-YS)+R(3,1)*(X(1,3)-ZS)/(R(1,3)*(X(1,1)-XS)+R(2,3)*(X(1,2)-YS)+R(3,3)*(X(1,3)-ZS);x_s(2,1)=-f*(R(1,2)*(X(1,1)-XS)+R(2,2)*(X(1,2)-YS)+R(3,2)*(X(1,3)-ZS)/(R(1,3)*(X(1,1)-XS)+R(2,3)*(X(1,2)-YS)+R(3,3)*(X(1,3)-ZS);x_s(3,1)=-f*(R(1,1)*(X(2,1)-XS)+R(2,1)*(X(2,2)-YS)+R(3,1)*(X(2,3)-ZS)/(R(1,3)*(X(2,1)-XS)+R(2,3)*(X(2,2)-YS)+R(3,3)*(X(2,3)-ZS);x_s(4,1)=-f*(R(1,2)*(X(2,1)-XS)+R(2,2)*(X(2,2)-YS)+R(3,2)*(X(1,3)-ZS)/(R(1,3)*(X(2,1)-XS)+R(2,3)*(X(2,2)-YS)+R(3,3)*(X(2,3)-ZS);x_s(5,1)=-f*(R(1,1)*(X(3,1)-XS)+R(2,1)*(X(3,2)-YS)+R(3,1)*(X(1,3)-ZS)/(R(1,3)*(X(3,1)-XS)+R(2,3)*(X(3,2)-YS)+R(3,3)*(X(3,3)-ZS);x_s(6,1)=-f*(R(1,2)*(X(3,1)-XS)+R(2,2)*(X(3,2)-YS)+R(3,2)*(X(1,3)-ZS)/(R(1,3)*(X(3,1)-XS)+R(2,3)*(X(3,2)-YS)+R(3,3)*(X(3,3)-ZS);x_s(7,1)=-f*(R(1,1)*(X(4,1)-XS)+R(2,1)*(X(4,2)-YS)+R(3,1)*(X(1,3)-ZS)/(R(1,3)*(X(4,1)-XS)+R(2,3)*(X(4,2)-YS)+R(3,3)*(X(4,3)-ZS);x_s(8,1)=-f*(R(1,2)*(X(4,1)-XS)+R(2,2)*(X(4,2)-YS)+R(3,2)*(X(1,3)-ZS)/(R(1,3)*(X(4,1)-XS)+R(2,3)*(X(4,2)-YS)+R(3,3)*(X(4,3)-ZS);a=zeros(8,6);for i=1:4 Z=(R(1,3)*(X(i,1)-XS)+R(2,3)*(X(i,2)-YS)+R(3,3)*(X(i,3)-ZS); a(i*2-1,1)=1/Z*(R(1,1)*f+R(1,3)*x_s(2*i-1,1); a(i*2-1,2)=1/Z*(R(2,1)*f+R(2,3)*x_s(2*i-1,1); a(i*2-1,3)=1/Z*(R(3,1)*f+R(3,3)*x_s(2*i-1,1); a(2*i,1)=1/Z*(R(1,2)*f+R(1,3)*x_s(2*i,1); a(2*i,2)=1/Z*(R(2,2)*f+R(2,3)*x_s(2*i,1); a(2*i,3)=1/Z*(R(3,2)*f+R(3,3)*x_s(2*i,1); a(i*2-1,4)=x_s(2*i,1).*sin(w)-(x_s(2*i-1,1)./f.*(x_s(2*i-1,1).*cos(k)-x_s(2*i,1).*sin(k)+f*cos(k)*cos(w); a(i*2-1,5)=-f*sin(k)-x_s(2*i-1,1)./f.*(x_s(2*i-1,1).*sin(k)+x_s(2*i,1).*cos(k);a(i*2-1,6)=x_s(2*i,1); a(2*i,4)=-x_s(2*i-1,1).*sin(w)-(x_s(2*i,1)./f.*(x_s(2*i-1,1).*cos(k)-x_s(2*i,1).*sin(k)-f*sin(k)*cos(w); a(2*i,5)=-f*sin(k)-x_s(2*i,1)./f.*(x_s(2*i-1,1).*sin(k)+x_s(2*i,1).*cos(k);a(2*i,6)=-x_s(i*2-1,1);endL=x_o-x_s;dx=(a*a)a)*L;num2str(a);disp(改正数);num2str(dx);size(dx);XS=XS+dx(1,1);YS=YS+dx(2,1);ZS=ZS+dx(3,1);p=p+dx(4,1);w=w+dx(5,1);k=k+dx(6,1);num=num+1;num2str(XS)num2str(YS)num2str(ZS)num2str(p)num2str(w)num2str(k)End程序中p=(弧度),w=(弧度) k=(弧度)XS(M)YS(M)ZS(M)(弧度)(弧度)(弧度)39795.45225827476.4623587572.685988-0.0039870.0021140.067678解析法相对定向是通过计算相对定向元素建立地面立