摄影测量作业3

sin(k);?doubleb2=cos(w)*cos(k);?doubleb3=-sin(w);?doublec1=sin(q)*cos(k)+cos(q)*sin(w)*sin(k);?doublec2=-sin(q)*sin(k)+cos(q)*sin(w)*cos(k);?doublec3=cos(q)*cos(w);?f=f/1000.0; for(inti=0;i<iRow;i++)?{ doubleZA=xyXYZ(i,4); doubleXA=xyXYZ(i,2); doubleYA=xyXYZ(i,3); doublex=(xyXYZ(i,0)-_wtof(strx0))/1000.0; doubley=(xyXYZ(i,1)-_wtof(stry0))/1000.0; double_Z=a3*(XA-XS)+b3*(YA-YS)+c3*(ZA-ZS); A(2*i,0)=(a1*f+a3*x)/_Z;?A(2*i,1)=(b1*f+b3*x)/_Z;?A(2*i,2)=(c1*f+c3*x)/_Z;?A(2*i,3)=y*sin(w)-(x*(x*cos(k)-y*sin(k))/f+f*cos(k))*cos(w);?A(2*i,4)=-f*sin(k)-x*(x*sin(k)+y*cos(k))/f;?A(2*i,5)=y;?A(2*i+1,0)=(a2*f+a3*y)/_Z;?A(2*i+1,1)=(b2*f+b3*y)/_Z;?A(2*i+1,2)=(c2*f+c3*y)/_Z;?A(2*i+1,3)=-x*sin(w)-(y*(x*cos(k)-y*sin(k))/f-f*sin(k))*cos(w);?A(2*i+1,4)=-f*cos(k)-y/f*(x*sin(k)+y*cos(k));?A(2*i+1,5)=-x;}?returnA;}