空间后方交会C程序代码.doc

摄影测量后方交会程序（c/c++）
输入数据截图：

结果截图：

程序源代码（其中的矩阵求逆在前面已经有了，HYPERLINK"http://hi.baidu.com/vcrs/blog/item/85b8a3dc46a7ea3e5882ddee.html"\t"_blank"链接）：
#include<stdio.h>#include<stdlib.h>#include<math.h>
constdoublePRECISION=1e-5;typedefdoubleDOUBLE[5];intInputData(int&Num,DOUBLE*&Data,double&m,double&f);intResection(constint&Num,constDOUBLE*&Data,constdouble&m,constdouble&f);intInverseMatrix(double*matrix,constint&row);
intmain(intargc,char*argv[]){DOUBLE*Data=NULL;intNum;doublef(0),m(0);if(InputData(Num,Data,m,f)){if(Data!=NULL){delete[]Data;}return1;}if(Resection(Num,Data,m,f)){if(Data!=NULL){delete[]Data;}return1;}if(Data!=NULL){delete[]Data;}printf("解算完毕...\n");
do{printf("计算结果保存于\"结果.txt\"文件中\n""请选择操作（输入P打开结果数据，R打开原始数据，其它退出程序）：");fflush(stdin);//刷新输入流charorder=getchar();if('P'==order||'p'==order){system("结果.txt");}elseif('R'==order||'r'==order){system("data.txt");}elsebreak;system("cls");}while(1);system("PAUSE");return0;}
/***********************************************函数名：InputData*函数介绍：从文件（data.txt）中读取数据,*文件格式如下：*点数m(未知写作0)*内方位元素(fx0y0)*编号xyXYZ*下面是一个实例：40153.24001-86.15-68.9936589.4125273.322195.172-53.4082.2137631.0831324.51728.693-14.78-76.6339100.9724934.982386.50410.4664.4340426.5430319.81757.31
*参数：(in/out)Num(点数)，*(in/out)Data(存放数据),m,f,x0,y0*返回值：int，0成功，1文件打开失败，2控制点个*数不足，3文件格式错误*作者：vcrs*完成时间：09-10-4**********************************************/intInputData(int&Num,DOUBLE*&Data,double&m,double&f){doublex0,y0;FILE*fp_input;if(!(fp_input=fopen("data.txt","r"))){return1;}
fscanf(fp_input,"%d%lf",&Num,&m);if(Num<4){return2;}
fscanf(fp_input,"%lf%lf%lf",&f,&x0,&y0);f/=1000;if(m<0||f<0){return3;}
Data=newDOUBLE[Num];double*temp=newdouble[Num-1];doublescale=0;
inti;for(i=0;i<Num;i++){//读取数据，忽略编号if(fscanf(fp_input,"%*d%lf%lf%lf%lf%lf",&Data[i][0],&Data[i][1],&Data[i][2],&Data[i][3],&Data[i][4])!=5){return3;}//单位换算成mData[i][0]/=1000.0;Data[i][1]/=1000.0;}
//如果m未知则归算其值if(0==m){for(i=0;i<Num-1;i++){temp[i]=(Data[i][2]-Data[i+1][2])/(Data[i][0]-Data[i+1][0])+(Data[i