//單張相片的空間后方交會程序
//說明：程序未作底片變形系統誤差改正，像點坐標直接使用且內方位元素X0=Y0=0像點坐標為等精度不相關觀測值
#include?
#include?//標準輸出輸入流
#include?//用于數學計算
#include??//調用函數exit（）需包含此文件
#include?//控制輸出格式需包含此文件
#include?“matrixfunction.h“//矩陣運算頭文件
int?N=4;//控制點總數
/////////////////////////////////讀入數據函數/////////////////////////////////////////

void?getdata（char?*filenamedouble?*xdouble?*ydouble?*x1double?*y1double?*z1）
//讀取數據文件（文件名，像x，像y，物x1，物y1，物z1）
{
	ifstream?filein（filenameios::in|ios::nocreate）;??
????//?以輸入方式打開一個文件，ios::nocreate表示原文件不存在時，不創(chuàng)建
	if（!filein）
	{??cout<<“打開文件失敗!文件可能不存在!“<	???exit（1）;
	}
	for（int?i=0;i		filein>>x[i]>>y[i]>>x1[i]>>y1[i]>>z1[i];//讀入每行（每個控制點）的像方和物方坐標
	filein.close（）;
}

int?main（）
{	
	int?ij;//循環(huán)所用輔助參數
	double?a1a2a3b1b2b3c1c2c3;//旋轉矩陣九個元素
	double?f=153.24;//攝影機主距（mm）
	double?X0=0;	double?Y0=0;//內方位元素為0
	double?M=50000;//攝影比例尺分母
	double?xsyszsfaiomgkaf;//6個外方位元素
	double?*A=new?double?[2*N*6];//存放外方位元素系數A的矩陣2i*6
	double?det[6];//6個外方位元素改正值矩陣
	double?*L=new?double?[2*N];
	double?*gpx=new?double?[N];double?*gpy=new?double?[N];double?*gpz=new?double?[N];//存儲控制點物方坐標
	double?*ipx=new?double?[N];double?*ipy=new?double?[N];//存儲控制點像方坐標
	double?*ipx0=new?double?[N];double?*ipy0=new?double?[N];//存儲由共線條件解算的近似像點坐標
	double?*AT=new?double[2*N*6];//存儲外方位元素系數轉置矩陣AT6*2i
	double?*TEP1=new?double[36];double?*TEP2=new?double[6];double?*TEP3=new?double?[36];//中間臨時矩陣
	double?Q[6];//存儲6個權倒數
	double?*V=new?double?[2*N];//存儲像點觀測值改正數
	double?Vsum=0m0;//單位權中誤差
	double?m[6];//存儲六個外方位元素的中誤差
	////////////////////////讀入觀測數據/////////////////////////////
	getdata（“sourcefile.txt“ipxipygpxgpygpz）;
	////////////////////////確定未知數的初始值////////////////////////
	f/=1000;//將主距f單位從mm劃成m
	fai=omg=kaf=0.0;
	xs=ys=0.0;zs=M*f;
	for（i=0;i	{
		ipx[i]/=1000;
		ipy[i]/=1000;
		xs+=gpx[i];
		ys+=gpy[i];
	}
	xs/=N;
	ys/=N;
	//////////////////////迭代///////////////////////
	while?（fabs（det[0]）>0.000001||fabs（det[1]）>0.000001||fabs（det[2]）>0.000001||fabs（det[3]）>2.90888208656e-5
		||fabs（det[4]）>2.90888208656e-5||fabs（det[5]）>2.90888208656e-5）	//2.90888208656e-5為0.1分換算成的弧度值
	{
		/////////////////計算旋轉矩陣
		a1=cos（fai）*cos（kaf）-sin（fai）*sin（omg）*sin（kaf）;
		a2=-cos（fai）*sin（kaf）-sin（fai）*sin（omg）*cos（kaf）;
		a3=-sin（fai）*cos（omg）;
		b1=cos（omg）*sin（kaf）;
		b2=cos（omg）*cos（kaf）;
		b3=-sin（omg）;
		c1=sin（fai）*cos（kaf）+cos（fai）*sin（omg）*sin（kaf）;
		c2=-sin（fai）*sin（kaf）+cos（fai）*sin（omg）*cos（kaf）;
		c3=cos（fai）*cos（omg）;

		///////////////////////////逐點計算///////////////////////////

		for?（i=0;i		{
			////////////////根據共線方程由初始外方位元素計算像點近似值//////////////////
			ipx0[i]=X0-f*（a1*（gpx[i]-xs）+b1*（gpy[i]-ys）+c1*（gpz[i]-zs））/（a3*（gpx[i]-xs）+b3*（gpy[i]-ys）+c3*（gpz[i]-zs））;
			ipy0[i]=Y0-f*（a2*（gpx[i]-xs）+b2*（gpy[i]-ys）+c2*（gpz[i]-zs））/（a3*（gpx[i]-xs）+b3*（gpy[i]-ys）+c3*（gpz[i]-zs））;
			//////////////////////逐點計算誤差方程的系數矩陣A///////////////

?屬性????????????大小?????日期????時間???名稱
-----------?---------??----------?-----??----

?????文件?????262236??2009-11-29?10:47??后方交會程序\Space?resection\Debug\Spaceresection.exe

?????文件?????304596??2009-11-29?10:47??后方交會程序\Space?resection\Debug\Spaceresection.ilk

?????文件?????484352??2009-11-29?10:47??后方交會程序\Space?resection\Debug\Spaceresection.pdb

?????文件??????58368??2010-05-30?21:49??后方交會程序\Space?resection\Debug\vc60.idb

?????文件??????69632??2009-11-29?10:47??后方交會程序\Space?resection\Debug\vc60.pdb

?????文件?????343148??2009-11-29?10:47??后方交會程序\Space?resection\Debug\Spaceresection.pch

?????文件??????40857??2009-11-29?10:47??后方交會程序\Space?resection\Debug\Spaceresection.obj

?????文件???????2949??2009-10-20?11:51??后方交會程序\Space?resection\matrixfunction.h

?????文件????????433??2009-11-29?10:47??后方交會程序\Space?resection\result.txt

?????文件????????244??2009-10-04?15:36??后方交會程序\Space?resection\sourcefile.txt

?????文件???????8103??2009-10-22?14:17??后方交會程序\Space?resection\Spaceresection.cpp

?????文件??????41984??2010-05-30?21:50??后方交會程序\Space?resection\Spaceresection.ncb

?????文件????????902??2009-11-29?10:47??后方交會程序\Space?resection\Spaceresection.plg

?????文件???????3497??2009-11-29?10:47??后方交會程序\Space?resection\Spaceresection.dsp

?????文件????????536??2009-11-29?10:47??后方交會程序\Space?resection\Spaceresection.dsw

?????文件??????53760??2010-05-30?21:50??后方交會程序\Space?resection\Spaceresection.opt

?????文件????????244??2009-10-04?15:36??后方交會程序\后方交會數據.txt

?????目錄??????????0??2009-10-25?21:11??后方交會程序\Space?resection\Debug

?????目錄??????????0??2009-10-25?21:11??后方交會程序\Space?resection

?????目錄??????????0??2009-11-22?09:30??后方交會程序

-----------?---------??----------?-----??----

??????????????1675841????????????????????20