作業(yè)4空間后方交會(huì)(已改無(wú)錯(cuò)字)
2023-04-24 07:03:37 本頁(yè)面
【正文】 ouble *ATL=new double[6]。double *Xg=new double[6]。//迭代計(jì)算do { //旋轉(zhuǎn)矩陣 R[0][0]=cos(Phi)*cos(Kappa)sin(Phi)*sin(Omega)*sin(Kappa)。 R[0][1]=cos(Phi)*sin(Kappa)sin(Phi)*sin(Omega)*cos(Kappa)。 R[0][2]=sin(Phi)*cos(Omega)。 R[1][0]=cos(Omega)*sin(Kappa)。 R[1][1]=cos(Omega)*cos(Kappa)。 R[1][2]=sin(Omega)。 R[2][0]=sin(Phi)*cos(Kappa)+cos(Phi)*sin(Omega)*sin(Kappa)。 R[2][1]=sin(Phi)*sin(Kappa)+cos(Phi)*sin(Omega)*cos(Kappa)。 R[2][2]=cos(Phi)*cos(Omega)。 for (i=0。iNum。i++) { double X=R[0][0]*(Data[i][2]Xs)+R[1][0]*(Data[i][3]Ys)+ R[2][0]*(Data[i][4]Zs)。 double Y=R[0][1]*(Data[i][2]Xs)+R[1][1]*(Data[i][3]Ys)+ R[2][1]*(Data[i][4]Zs)。 double Z=R[0][2]*(Data[i][2]Xs)+R[1][2]*(Data[i][3]Ys)+ R[2][2]*(Data[i][4]Zs)。 double xxx,yyy。 xxx=f*X/Z。 yyy=f*Y/Z。 //常數(shù)項(xiàng) L[2*i]=Data[i][0](f*X/Z)。 L[2*i+1]=Data[i][1](f*Y/Z)。 A[2*i][0]=(R[0][0]*f+R[0][2]*(xxx))/Z。 A[2*i][1]=(R[1][0]*f+R[1][2]*(xxx))/Z。 A[2*i][2]=(R[2][0]*f+R[2][2]*(xxx))/Z。 A[2*i][3]=(yyy)*sin(Omega)(((xxx)/f)* ((xxx)*cos(Kappa)(yyy)*sin(Kappa))+ f*cos(Kappa))*cos(Omega)。 A[2*i][4]=f*sin(Kappa)((xxx)/f)*((xxx)* sin(Kappa)+(yyy)*cos(Kappa))。 A[2*i][5]=(yyy)。 A[2*i+1][0]=(R[0][1]*f+R[0][2]*(yyy))/Z。 A[2*i+1][1]=(R[1][1]*f+R[1][2]*(yyy))/Z。 A[2*i+1][2]=(R[2][1]*f+R[2][2]*(yyy))/Z。 A[2*i+1][3]=(xxx)*sin(Omega)(((yyy)/f)* ((xxx)*cos(Kappa)(yyy)*sin(Kappa)) f*sin(Kappa))*cos(Omega)。 A[2*i+1][4]=f*cos(Kappa)((yyy)/f)*((xxx)* sin(Kappa)+(yyy)*cos(Kappa))。 A[2*i+1][5]=(xxx)。 } //求矩陣A的轉(zhuǎn)置矩陣AT for (i=0。i2*Num。i++) { for (j=0。j6。j++) { *(AT+j*2*Num+i)=A[i][j]。 } } //求ATA MatrixMul(AT,6,amp。A[0][0],6,2*Num,ATA)。 if(InverseMatrix(ATA,6)) return 1。 MatrixMul(AT,6,L,1,2*Num,ATL)。 MatrixMul(ATA,6,ATL,1,6,Xg)。 Xs+=Xg[0]。 Ys+=Xg[1]。 Zs+=Xg[2]。 Phi+=Xg[3]。 Omega+=Xg[4]。 Kappa+=Xg[5]。} while(fabs(Xg[0])=PRECISION ||fabs(Xg[1])=PRECISION || fabs(Xg[2])=PRECISION ||fabs(Xg[3])=PRECISION || fabs(Xg[4])=PRECISION || (Xg[5])=PRECISION)。//注：協(xié)因數(shù)陣，旋轉(zhuǎn)矩陣等計(jì)算本應(yīng)該使用最后外方位元素值，//由于變換很小忽略double *Q=ATA。double *V=new double[2*Num]。MatrixMul(amp。A[0][0],2*Num,Xg,1,6,V)。double VTV=0。for(i=0。i2*Num。i++){ V[i]=L[i]。 VTV+=V[i]*V[i]。}double m0=sqrt(VTV/(2*Num6))。double *mm=new double[6]。for (i=0。i6。i++){ mm[i]=sqrt(*(Q+i*6+i))*m0。}OutPut(Q,mm,m0,Xs,Ys,Zs,Phi,Omega,Kappa,amp。R[0][0])。delete []L。delete []A。delete []AT。delete []ATA。del
教學(xué)教案相關(guān)推薦
鄂ICP備17016276號(hào)-1