摄影测量单片空间后方交会程序《C++》

合集下载

相关主题

1、下载文档前请自行甄别文档内容的完整性，平台不提供额外的编辑、内容补充、找答案等附加服务。
2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
3、如文档侵犯您的权益，请联系客服反馈,我们会尽快为您处理(人工客服工作时间：9:00-18:30)。

输入文件形式如下：

C++源程序如下：

#include

using namespace std;

const int n=6;

void inverse (double c[n][n]);

templatevoid transpose (T1*mat1,T2*mat2,int a,int b); templatevoid multi(T1*mat1,T2 * mat2,T2 * result,int a,int b,int c);

templatevoid input (T*mat,int a,int b);

templatevoid output(T*mat,char*s,int a,int b);

int main()

{

ofstream outFile;

cout.precision(5);

double x0=0.0, y0=0.0; double fk=0.15324; //内方位元素

double m=39689; //估算比例尺

double B[4][5]={0.0},R[3][3],XG[6][1],AT[6][8],ATA[6][6],ATL[6][1];

input (B,4,5); //从文件中读取控制点的影像坐标和地面坐标，存入数组B double Xs=0.0, Ys=0.0, Zs=0.0,Q=0.0,W=0.0,K=0.0;

double X,Y,Z,L[8][1],A[8][6];

//确定未知数的出始值

for(int i=0;i<4;i++)

{Xs=Xs+B[i][2];

Ys=Ys+B[i][3];

Zs=Zs+B[i][4];

}

Xs=Xs/4; Ys=Ys/4; Zs=Zs/4+m*fk;

int f=0;

do//迭代计算

{f++;

//组成旋转矩阵

R[0][0]=cos(Q)*cos(K)-sin(Q)*sin(W)*sin(K);

R[0][1]=-cos(Q)*sin(K)-sin(Q)*sin(W)*cos(K);

R[0][2]=-sin(Q)*cos(W);

R[1][0]=cos(W)*sin(K);

R[1][1]=cos(W)*cos(K);

R[1][2]=-sin(W);

R[2][0]=sin(Q)*cos(K)+cos(Q)*sin(W)*sin(K);

R[2][1]=-sin(Q)*sin(K)+cos(Q)*sin(W)*cos(K);

R[2][2]=cos(Q)*cos(W);

//计算系数阵和常数项

for(int i=0,k=0,j=0;i<=3;i++,k++,j++)

{

X=R[0][0]*(B[i][2]-Xs)+R[1][0]*(B[i][3]-Ys)+R[2][0]*(B[i][4]-Zs);

Y=R[0][1]*(B[i][2]-Xs)+R[1][1]*(B[i][3]-Ys)+R[2][1]*(B[i][4]-Zs);

Z=R[0][2]*(B[i][2]-Xs)+R[1][2]*(B[i][3]-Ys)+R[2][2]*(B[i][4]-Zs);

L[j][0]=B[i][0]-(x0-fk*X/Z);

L[j+1][0]=B[i][1]-(y0-fk*Y/Z);

j++;

A[k][0]=(R[0][0]*fk+R[0][2]*(B[i][0]-x0))/Z;

A[k][1]=(R[1][0]*fk+R[1][2]*(B[i][0]-x0))/Z;

A[k][2]=(R[2][0]*fk+R[2][2]*(B[i][0]-x0))/Z;

A[k][3]=(B[i][1]-y0)*sin(W)-((B[i][0]-x0)*((B[i][0]-x0)*cos(K)-(B[i][1]-y0) *sin(K))/fk+fk*cos(K))*cos(W);

A[k][4]=-fk*sin(K)-(B[i][0]-x0)*((B[i][0]-x0)*sin(K)+(B[i][1]-y0)*cos(K))/ fk;

A[k][5]=B[i][1]-y0;

A[k+1][0]=(R[0][1]*fk+R[0][2]*(B[i][1]-y0))/Z;

A[k+1][1]=(R[1][1]*fk+R[1][2]*(B[i][1]-y0))/Z;

A[k+1][2]=(R[2][1]*fk+R[2][2]*(B[i][1]-y0))/Z;

A[k+1][3]=-(B[i][0]-x0)*sin(W)-((B[i][1]-y0)*((B[i][0]-x0)*cos(K)-(B[i][1] -y0)*sin(K))/fk-fk*sin(K))*cos(W);

A[k+1][4]=-fk*cos(K)-(B[i][1]-y0)*((B[i][0]-x0)*sin(K)+(B[i][1]-y0)*cos(K ))/fk;

A[k+1][5]=-(B[i][0]-x0);