后方交会C++程序

后方交会计算代码，包含示例控制点坐标文件

// houf1.cpp : 定义控制台应用程序的入口点。
//

#include “stdafx.h“
#include 
#include 
#include 
#include 
#include 
using namespace std;
const int n=6;
void inverse （double c[n][n]）;
templatevoid transpose （T1*mat1T2*mat2int aint b）;
templatevoid multi（T1*mat1T2 * mat2T2 * resultint aint bint c）;
templatevoid input （T*matint aint b）;
templatevoid output（T*matchar*sint aint b）;

int _tmain（int argc _TCHAR* argv[]）
{
		ofstream outFile;  //输入流定义对象outFile
		cout.precision（5）;//设置精确度为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 （B45）;   //从文件中读取控制点的影像坐标和地面坐标，存入数组B，每一行像点坐标，地面点坐标
		double Xs=0.0 Ys=0.0 Zs=0.0Q=0.0W=0.0K=0.0; //外方位元素初始值
		double XYZL[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=0k=0j=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三个点组成的矩阵，
			A[k][0]=（R[0][0]*fk+R[0][2]*（B[i][0]-x0））/Z;//像平面坐标下的x、 y
			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）;
			k++;
		}
	//计算法方程的系数矩阵和常数项
		transpose（AAT68）;//计算转置
		multi（ATAATA686）;//相乘
		inverse（ATA）;//求逆
		multi（ATLATL681）;//相乘
	
		//求解X即改正数
		multi（ATAATLXG661）;//相乘
		//与参数近似值相加得到新的参数近似值	
		Xs=Xs+XG[0][0]; Ys=Ys+XG[1][0]; Zs=Zs+XG[2][0];
		Q=Q+XG[3][0];  W=W+XG[4][0];  K=K+XG[5][0];
		}while（XG[3][0]>=6.0/206265.0||XG[4][0]>

 属性            大小     日期    时间   名称
----------- ---------  ---------- -----  ----
     目录           0  2016-09-22 20:59  houf1\
     目录           0  2016-09-22 08:36  houf1\Debug\
     文件       96256  2016-09-21 09:09  houf1\Debug\houf1.exe
     文件      656244  2016-09-21 09:09  houf1\Debug\houf1.ilk
     文件     1010688  2016-09-21 09:09  houf1\Debug\houf1.pdb
     目录           0  2016-09-22 08:36  houf1\houf1\
     文件     6377472  2016-09-22 20:59  houf1\houf1.sdf
     文件         882  2014-01-08 09:34  houf1\houf1.sln
     文件       18944  2016-09-22 20:59  houf1\houf1.suo
     文件        2601  2016-09-21 09:13  houf1\houf1\aim.txt
     目录           0  2016-09-22 08:36  houf1\houf1\Debug\
     文件        4634  2016-09-21 09:09  houf1\houf1\Debug\cl.command.1.tlog
     文件       34208  2016-09-21 09:09  houf1\houf1\Debug\CL.read.1.tlog
     文件        2894  2016-09-21 09:09  houf1\houf1\Debug\CL.write.1.tlog
     文件        2502  2014-01-08 11:06  houf1\houf1\Debug\houf1.Build.CppClean.log
     文件         406  2014-01-08 11:06  houf1\houf1\Debug\houf1.exe.embed.manifest
     文件         472  2016-09-21 09:09  houf1\houf1\Debug\houf1.exe.embed.manifest.res
     文件         381  2016-09-21 09:09  houf1\houf1\Debug\houf1.exe.intermediate.manifest
     文件          90  2016-09-21 09:13  houf1\houf1\Debug\houf1.lastbuildstate
     文件         951  2016-09-21 09:13  houf1\houf1\Debug\houf1.log
     文件      226869  2016-09-21 09:09  houf1\houf1\Debug\houf1.obj
     文件     1179648  2016-09-21 09:09  houf1\houf1\Debug\houf1.pch
     文件         200  2014-01-08 11:06  houf1\houf1\Debug\houf1_manifest.rc
     文件           2  2016-09-21 09:09  houf1\houf1\Debug\link.6188.read.1.tlog
     文件           2  2016-09-21 09:09  houf1\houf1\Debug\link.6188.write.1.tlog
     文件           2  2016-09-21 09:09  houf1\houf1\Debug\link.6188-cvtres.read.1.tlog
     文件           2  2016-09-21 09:09  houf1\houf1\Debug\link.6188-cvtres.write.1.tlog
     文件        5282  2016-09-21 09:09  houf1\houf1\Debug\link.command.1.tlog
     文件       10332  2016-09-21 09:09  houf1\houf1\Debug\link.read.1.tlog
     文件        3080  2016-09-21 09:09  houf1\houf1\Debug\link.write.1.tlog
     文件           2  2016-09-21 09:09  houf1\houf1\Debug\link-cvtres.read.1.tlog
............此处省略23个文件信息