摄影测量空间前方交会

摄影测量空间前方交会 VC++编写 点投影系数的空间前方交会算法 printf("请输入1505标志点像方坐标(像素)：\n"); scanf("%lf %lf",&i[0],&j[0]); printf("请输入1504标志点像方坐标(像素)：\n"); scanf("%lf %lf",&i[1],&j[1]); m1[0]=(ha0+ha1*i[0]+ha2*j[0])/1000; m1[1]=(ka0+ka1*i[0]+ka2*j[0])/1000; m2[0]=(hb0+hb1*i[1]+hb2*j[1])/1000; m2[1]=(kb0+kb1*i[1]+kb2*j[1])/1000; //计算Bx，BY，BZ Bx=(sx2-sx1); By=(sy2-sy1); Bz=(sz2-sz1); //计算旋转矩阵R1和R2 RotationMatrix(phi1,omega1,kappa1,R1); RotationMatrix(phi2,omega2,kappa2,R2); //计算d1[3]:dx1,dy1,dz1和d2[3]:dx2,dy2,dz2; MultMatrix(R1,m1,d1,3,3,1); MultMatrix(R2,m2,d2,3,3,1);