文档介绍：#include<iostream>#include<cmath>usingnamespacestd;constintN=4;constintn=6;/*---------------矩阵相乘---------------------*/voidmult(double*m1,double*m2,double*result,inti_1,intj_12,intj_2){inti,j,k;for(i=0;i<i_1;i++)for(j=0;j<j_2;j++){result[i*j_2+j]=;for(k=0;k<j_12;k++)result[i*j_2+j]+=m1[i*j_12+k]*m2[j+k*j_2];}return;}/*---------------矩阵求逆---------------------*/voidinverse(doublec[n][n]){inti,j,h,k;doublep;doubleq[n][12];for(i=0;i<n;i++)//构造高斯矩阵for(j=0;j<n;j++)q[i][j]=c[i][j];for(i=0;i<n;i++)for(j=n;j<12;j++){if(i+6==j)q[i][j]=1;elseq[i][j]=0;}for(h=k=0;k<n-1;k++,h++)//消去对角线以下的数据for(i=k+1;i<n;i++){if(q[i][h]==0)continue;p=q[k][h]/q[i][h];for(j=0;j<12;j++){q[i][j]*=p;q[i][j]-=q[k][j];}}for(h=k=n-1;k>0;k--,h--)//消去对角线以上的数据for(i=k-1;i>=0;i--){if(q[i][h]==0)continue;p=q[k][h]/q[i][h];for(j=0;j<12;j++){q[i][j]*=p;q[i][j]-=q[k][j];}}for(i=0;i<n;i++){//将对角线上数据化为1p=[i][i];for(j=0;j<12;j++)q[i][j]*=p;}for(i=0;i<n;i++)//提取逆矩阵for(j=0;j<n;j++)c[i][j]=q[i][j+6];}/*---------------矩阵转置---------------------*/voidtranspose(double*m1,double*m2,intm,intn){//矩阵转置inti,j;for(i=0;i<m;i++)for(j=0;j<n;j++)m2[j*m+i]=m1[i*n+j];return;}voidmain(){doubleXs,Ys,Zs,q,w,k;doubleXsr,Ysr,Zsr,qr,wr,kr;//doublea[3],b[3],c[3];doublear[3],br[3],cr[3];//doublex0,y0,f;doublex[N],y[N];doubleX[N],Y[N],Z[N];doublex1[N],y1[N];doublexr[N],yr[N];//doublex1r[N],y1r[N];//doublem;doubleL[2*N];doubleLr[2*N];//doubleXX[6];doubleXXr[6];//doubleA[2*N][6];doubleB[2*N][6];//doubleX0[N],Y0[N],Z0[N],At[6][2*N],result1[6][6],result2[6][1];doubleX0r[N],Y0r[N],Z0r[N],Bt[6][2*N],result1r[6][6],result2r[6][1];//doubleR1[3][3],R2[3][3],XI1[3],XII1[3],XI2[3],XII2[3],XI3[3],XII3[3],XI4[3],XII4[3],XI5[3],XII5[3];doubleN1,N2,N3,N4,N5,BX,BY,BZ,G[5][3];doubleRS1[3][1],RSR1[3][1],RS2[3][1],RSR2[3][1],RS3[3][1],RSR3[3][1],RS4[3][1],RSR4[3][1],RS5[3][1],RSR5[3][1];inti,j,n=0,nr=0;doublesum=0;doublem1,n1,m2,n2,m3,n3,m4,n4,m5,n5,p1,q1,p2,q2,p3,q3,p4,q4,p5,q5;/*---------------输入点地面坐标---------------------*/X[0]=;X[1]=;X[