//?houf1.cpp?:?定義控制臺應(yīng)用程序的入口點。
//

#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）;//設(shè)置精確度為5位并返回上一次的設(shè)置。
		double?x0=0.0?y0=0.0;?//
		double?fk=0.15324;???//內(nèi)方位元素（外業(yè)測量）
		double?m=39689;??//估算比例尺（平均行高）
		double?B[4][5]={0.0}R[3][3]XG[6][1]AT[6][8]ATA[6][6]ATL[6][1];//定義二位數(shù)組用于存儲數(shù)據(jù)
		input?（B45）;???//從文件中讀取控制點的影像坐標(biāo)和地面坐標(biāo)，存入數(shù)組B，每一行像點坐標(biāo)，地面點坐標(biāo)
		double?Xs=0.0?Ys=0.0?Zs=0.0Q=0.0W=0.0K=0.0;?//外方位元素初始值
		double?XYZL[8][1]A[8][6];?
	
		//確定未知數(shù)的初始值
		for（int?i=0;i<4;i++）
		{
		Xs=Xs+B[i][2];
		Ys=Ys+B[i][3];
		Zs=Zs+B[i][4];
		}//求待定參數(shù)初始值
		Xs=Xs/4;?Ys=Ys/4;?Zs=Zs/4+m*fk;
		
		int?f=0;//控制循環(huán)
		
		do//迭代計算
		{f++;
		//組成旋轉(zhuǎn)矩陣
		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）;
		//計算系數(shù)陣和常數(shù)項
		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）;//引入記號以便計算偏導(dǎo)數(shù)
			L[j][0]=B[i][0]-（x0-fk*X/Z）;//常數(shù)項
			L[j+1][0]=B[i][1]-（y0-fk*Y/Z）;
			j++;//系數(shù)陣A三個點組成的矩陣，
			A[k][0]=（R[0][0]*fk+R[0][2]*（B[i][0]-x0））/Z;//像平面坐標(biāo)下的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++;
		}
	//計算法方程的系數(shù)矩陣和常數(shù)項
		transpose（AAT68）;//計算轉(zhuǎn)置
		multi（ATAATA686）;//相乘
		inverse（ATA）;//求逆
		multi（ATLATL681）;//相乘
	
		//求解X即改正數(shù)
		multi（ATAATLXG661）;//相乘
		//與參數(shù)近似值相加得到新的參數(shù)近似值	
		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個文件信息