摄影测量空间前方交会
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);
2021-11-28 17:29:26
212KB
前方交会
1