单像空间后方交会程序报告

1、单像空间后方交会程序报告指导老师：刘老师班 级：测绘 101姓 名：尚锋学 号： 19 号1、应用程序的主入口部分的代码：using System;using System.Collections.Generic;using System.Linq;using System.Windows.Forms;namespace 单像空间后方交会static class Program/ / 应用程序的主入口点。/ STAThreadstatic void Main()Application .EnableVisualStyles();Application .SetCompatibleTextRen

2、deringDefault( false );Application .Run( new Form1();2、方法解算类（通用）部分的代码：using System;using System.Collections.Generic;using System.Linq;using System.Text;namespace 单像空间后方交会class Tongyongstruct image_point / 一个像点结构，包含像点坐标和地面点坐标 public double x;public double y;public double X;public double Y;privatedoub

3、le f;/ 主距privatedouble u;/u 为外方位元素，下面 5个相同privatedouble w;privatedouble k;privatedouble Xs;privatedouble Ys;privatedouble Zs;privateimage_point p =new image_point 4;/ 四个控制点privatedouble R= new double 9; / 旋转矩阵privatedouble a =new double 8;/ 像点坐标近似值privatedouble , A= newdouble 8, 6;/ 误差方程式系数privatedo

4、uble L =new double 8; / 误差方程式常数项privateint count =0; /统计代次数publicmTongyong( double g,double q) / 构造函数，初始化各变= g;for( int i = 0; i 4; i+)int j = i * 5;pi.x =qj;pi.y =qj + 1;pi.X =qj + 2;pi.Y =qj + 3;pi.Z =qj + 4;double ave = 0, sum = 0;/ 求比例尺分母for( int i = 0; i 3; i+)public double Z;for ( int j = i +

5、1; j 4; j+)量, 单位sum +=Math.Sqrt( Math.Pow(pi.X - pj.X, 2) +Math.Sqrt( Math.Pow(pi.x - pj.x, 2)Math.Pow(pi.Y - pj.Y, 2) / + Math.Pow(pi.y - pj.y, 2); ave = sum / 6; u = 0;/ 给定外方位元素的初始值 , 角度均设置为 0w = 0;k = 0;/Xs 为四个控Xs = (p0.X + p1.X + p2.X + p3.X) / 4; 制点X的平均值，Ys类似Ys = (p0.Y + p1.Y + p2.Y + p3.Y) / 4

6、;Zs = (p0.Z + p1.Z + p2.Z + p3.Z) / 4 + ave * f;private double sin( double m) / 正弦，为简化而写 , 下同return Math.Sin(m); private double cos( double m)return Math.Cos(m); private void calcos() / 计算旋转矩阵R0 = cos(u) * cos(k) - sin(u) * sin(w) * sin(k);R1 = -cos(u) * sin(k) - sin(u) * sin(w) * cos(k);R2 = -sin(u

7、) * cos(w);R3 = cos(w) * sin(k);R4 = cos(w) * cos(k);R5 = -sin(w);R6 = sin(u) * cos(k) + cos(u) * sin(w) * sin(k);R7 = cos(u) * sin(w) * cos(k) - sin(u) * sin(k);R8 = cos(u) * cos(w);private void calabout() / 像点坐标的近似值int i;for (i = 0; i 4; i+) a2 * i = -f * (R0 * (pi.X - Xs) + R3 * (pi.Y- Ys) + R6 *

8、 (pi.Z - Zs) / (R2 * (pi.X - Xs) + R5 * (pi.Y- Ys) + R8 * (pi.Z - Zs);a2 * i + 1 = -f * (R1 * (pi.X - Xs) + R4 * (pi.Y - Ys) + R7 * (pi.Z - Zs) / (R2 * (pi.X - Xs) + R5 * (pi.Y- Ys) + R8 * (pi.Z - Zs);private void calxx() / 误差方程式的系数和常数项int i;for (i = 0; i 4; i+)/ 系数double z = R2 * (pi.X - Xs) + R5 *

9、 (pi.Y - Ys)+ R8 * (pi.Z - Zs); int n = i * 2;An, 0 = (R0 * f + R2 * pi.x) / z;An, 1 = (R3 * f + R5 * pi.x) / z;An, 2 = (R6 * f + R8 * pi.x) / z;An, 3 = pi.y * sin(w) - f * cos(w) * cos(k) - pi.x / f * (pi.x * cos(w) * cos(k) - pi.y * cos(w) * sin(k);An, 4 = -f * sin(k) - pi.x / f * (pi.x * sin(k) +

10、 pi.y * cos(k);An, 5 = pi.y;An + 1, 0 = (R1 * f + R2 * pi.y) / z;An + 1, 1 = (R4 * f + R5 * pi.y) / z;An + 1, 2 = (R7 * f + R8 * pi.y) / z;An + 1, 3 = -pi.x * sin(w) + f * cos(w) * sin(k) -pi.x / f * (pi.x * cos(w) * cos(k) - pi.y * sin(k) * cos(w);An + 1, 4 = -f * cos(k) - pi.y / f * (pi.x * sin(k)

11、 + pi.y * cos(k);An + 1, 5 = -pi.x;for (i = 0; i 4; i+) / 常数项L2 * i = pi.x - a2 * i;L2 * i + 1 = pi.y - a2 * i + 1;private double calAdd()double , temp =new double 6, 6;A 的转置与 A相乘的积double , ANew =new double 6, 8;/A 的转置double t =new double 6;/A 的转置与 L相乘的积double X =new double6;/ 改正数int i, j, n;for (i

12、= 0; i 8; i+)/ 求A的转置 ANewfor (j = 0; j 6; j+)ANewj, i = Ai, j;for (i = 0; i 6; i+)/求A的转置与A相乘的积tempfor (j = 0; j 6; j+)tempi, j = 0;for (n = 0; n 8; n+)tempi, j += ANewi, n * An, j;MATINV(temp); /temp 的逆，保存在本身矩阵中 for (i = 0; i 6; i+)/求A的转置与L的乘积tti = 0; for (j = 0; j 8; j+) ti += ANewi, j * Lj;for (i

13、= 0; i 6; i+)/ 求改正数 XXi = 0;for (j = 0; j 0.00001)/ 迭代至最大改正数 =0.00001为止calcos(); calabout();calxx();VALUE = calAdd();count+;private void MATINV(double , c)/ 求6阶矩阵的逆int i, j, h, m;const int n = 6; double l;double , q = new double n, 12;for (i = 0; i n; i+) / 构造高斯矩阵for (j = 0; j n; j+) qi, j = ci, j;f

14、or (i = 0; i n; i+) / 单位矩阵for (j = n; j 12; j+)if (i + 6 = j)qi, j = 1; else qi, j = 0;for (h = 0, m = 0; m n - 1; m+, h+)/ 消去对角线以下的数据for (i = m + 1; i n; i+)if (qi, h = 0d) continue ;l = qm, h / qi, h;for (j = 0; j 0; m-, h-)/ 消去对角线以上的数据for (i = m - 1; i = 0; i-)if (qi, h = 0d) continue ;l = qm, h

15、/ qi, h;for (j = 0; j 12; j+)qi, j *= l;qi, j -= qm, j;for (i = 0; i n; i+)/ 将对角线上数据化为 1l = 1.0 / qi, i;for (j = 0; j 12; j+)qi, j *= l;for (i = 0; i n; i+)/ 提取逆矩阵for (j = 0; j n; j+)ci, j = qi, j + 6;private double maxone(double Arr)/ 返回六个元素中的最大值double ARR = new double 6;for ( int i = 0; i 6; i+)AR

16、Ri = Arri;if (ARRi 0d) / 取正ARRi = -ARRi;Array .Sort(ARR, 0, 6);return ARR5;public int COUNTgetreturn count;public double Ugetu;returnpublicdoubleWgetreturnw;publicdoubleKgetreturnk;publicdoubleXSgetreturnXs;publicdoubleYSgetreturnYs;publicdoubleZSgetreturnZs;3、窗体一部分的代码：using System;using System.Coll

17、ections.Generic;using System.ComponentModel;using System.Data;using System.Drawing;using System.Linq;using System.Text;using System.Windows.Forms;using System.Diagnostics;using System.Data.OleDb;using System.IO;namespace 单像空间后方交会public partial class Form1: Formprivate double data = new double 20; /

18、保存表中的数据 private double f = 0; / 主距 public Form1()InitializeComponent();private void Form1_Load( object sender, EventArgs e)/ TODO: 这行代码将数据加载到表“ database1DataSet1.data 中。您可以根据需要移动或移除它。this .dataTableAdapter.Fill( this .database1DataSet1.data); copyFile(); / 复制数据文件tryf = 153.24 / 1000;/ 主距为固定值for ( in

19、t i = 0; i 4; i+)int j = 5 * i;dataj =double .Parse( this .DGV.Rowsi.Cells1.Value.ToString() / 1000; dataj + 1 =double .Parse( this .DGV.Rowsi.Cells2.Value.ToString() / 1000; dataj + 2 =double .Parse( this .DGV.Rowsi.Cells3.Value.ToString();dataj + 3 =double .Parse( this .DGV.Rowsi.Cells4.Value.ToSt

20、ring();dataj + 4 =double .Parse( this .DGV.Rowsi.Cells5.Value.ToString(); catch ( Exception o) / 载入数据出错，程序将无法开始计算 MessageBox.Show(o.Message, 提示 ,MessageBoxButtons.OK, MessageBoxIcon.Information);btnStart.Enabled = false ; this .label2.Text = ;this .textBox1.Text = C:Documents and桌面 RESULT.txt ; / 默认

21、结果保存在桌面this .label2.Text = 准备就绪 ; btnCheck.Enabled = false ; / 查看解算结果不可用 private void btnExit_Click( object sender, EventArgs e)Application .Exit();private void btnFilePath_Click( object sender, EventArgs e) folderBrowserDialog1.ShowNewFolderButton = true ;if (folderBrowserDialog1.ShowDialog() = Dia

22、logResult .OK) string s = folderBrowserDialog1.SelectedPath + + RESULT.txt ;if (s.Contains( ) = true ) / 解决根目录下出现如同 C:RESULT.txt 等不正确路径情况 s = s.Replace( , ); this .textBox1.Text = s;private void btnStart_Click( object sender, EventArgs e) btnCheck.Enabled = false ; / 解算过程中不响应按键btnExit.Enabled = fals

23、e ;false ;程序解算中，请稍等btnStart.Enabled =this .label2.Text = tryTongyong s = new Tongyong(f, data); / 新建实例解算 ,传入数据s.makeSure(); / 迭代解算this .label2.Text = 解算完成 , 迭代次数 : + s.COUNT.ToString(); / 显示状态StreamWriter/ 保存结果文件sw = newStreamWriter (this .textBox1.Text);sw.WriteLine(stringsw.WriteLine(stringsw.Writ

24、eLine(stringsw.WriteLine(stringsw.WriteLine(stringsw.WriteLine(stringsw.Close();.Format( u=0:F9 , s.U);.Format( w=0:F10 , s.W);.Format( k=0:F9 , s.K);.Format( Xs=0:F5 , s.XS);.Format( Ys=0:F5 , s.YS);try / 若成功则解算完成后自动打开结果文档Process p = new Process ();p.StartInfo.FileName =this .textBox1.Text;.Format( Zs=0:F6 , s.ZS);p.Start(); catch ( Exception o)MessageBox.Show(o.Message, 提示,MessageBoxButtons.OK, MessageBoxIcon.Information);catch / 解算失败，报错MessageBox.Show( 解算失败 ! , 提示 btnCheck.Enabled = btnExit.Enabled = btnStart.Enabled =MessageBoxButtons