#include?
#include?
#include?
#include?
#include?
#include?
#include?
#include?
#include?“MatrixOperation.h“
#include?“CResection.h“
//Download?by?http://www.codefans.net
#define?MAXITERATION?10
#define??PI?3.1415926
using?namespace?std;

CResection::~CResection（）
{

}

CResection::CResection（）
{
	bDone?=?false;
}

CResection::CResection（double?PhotographicScale?double?focus?char*?filePathName）
{
	bDone?=?false;

	m?=?PhotographicScale;
	f?=?focus;
	dotNum?=?0;
	sd.empty（）;
	memcpy（filenamefilePathNameMAX_PATH）;
	InitData（）;
	Iterator（）;
}

void?CResection::InitData（）
{
	//打開文件以備讀取數據
//	cout?<<“開始讀取數據...“<	ifstream?datafile1（filenameios::in?|?ios::nocreate）;
	if（?!datafile1）
	{
//		cout<<“打開文件失敗?文件可能不存在“<//		system（“pause“）;
		_exit（1）;
	}

	int?i;	//文本文件行數，即已知點個數
	string?temp;

	while（getline（datafile1?temp））
		dotNum?++;	//統計行數
	datafile1.close（）;

	ifstream?datafile2（filenameios::in?|?ios::nocreate）;
	SourceData?sdtemp;
	for?（i?=?0;?i?!=?dotNum;?i?++）
	{
		datafile2?>>?sdtemp.x?>>?sdtemp.y?>>?sdtemp.X?>>?sdtemp.Y?>>?sdtemp.Z;
		sd.push_back（sdtemp）;
	}

	datafile2.close（）;

//	cout?<<“讀取數據完畢...“<}

bool?CResection::CheckPrecision（double*?deta）
{
	//2.9088820866572159615394846141477e-5?即?0.1′的弧度表示
	bool?ret;
	ret?=?（fabs（deta[0]）<0.000001?&&?fabs（deta[1]）<0.000001	&&?fabs（deta[2]）<0.000001?&&?\
		fabs（deta[3]）<2.90888208656e-5?&&?fabs（deta[4]）<2.90888208656e-5?&&?\
		fabs（deta[5]）<2.90888208656e-5）;
	return?ret;
}

void?CResection::Iterator（）
{
	double?phi?omega?kappa?Xs?Ys?Zs;
	phi?=?omega?=?kappa?=0.0;
	Xs?=?Ys?=?Zs?=?0.0;

	for?（int?k=0;k	{
		sd[k].x?/=?1000.0;
		sd[k].y?/=?1000.0;
		Xs?+=?sd[k].X;
		Ys?+=?sd[k].Y;
	}

	Xs?/=?dotNum;
	Ys?/=?dotNum;
	
	f?=?f?/?1000.0;
	Zs?=m*f;
	
//	cout<//	cout?<<“Xs:?“<//	cout?<<“phi:?“<
	//聲明并初始化六元素改正數矩陣
	double?deta[6]?=?{111111};

	double?x0（0）;
	double?y0（0）;//內方位元素

	double?*X0?*Y0?*Z0;
	X0?=?new?double[dotNum];
	Y0?=?new?double[dotNum];
	Z0?=?new?double[dotNum];
	memset（X00dotNum*sizeof（double））;
	memset（Y00dotNum*sizeof（double））;
	memset（Z00dotNum*sizeof（double））;
	
	double?A[2*6]?=?{0.0};
	double?AT[6*2]?=?{0.0};

	double?Buf1[36]?=?{0.0};
	double?Buf2[36]?=?{0.0};//ATA累加

	double?Buf3[6]?=?{0.0};
	double?Buf4[6]?=?{0.0};//ATL累加
	
	double?Buf5[8*6]?=?{0.0};//存儲8×6的A矩陣，沒辦法
	double?Buf6[8*1]?=?{0.0};//存儲8×1的L矩陣，同上
	double?V[8*1]?=?{0.0};

	double?ATA[36]?=?{0.0};
	double?ATL[6]?=?{0.0};
	double?L[2]?=?{0.0};


	int?iCount?=?0;//迭代次數
//	cout?<	while（!CheckPrecision（deta））
	{
//		cout?<
		if?（iCount?==?MAXITERATION）
		{
//			cout?<