摄影测量学单像空间后方交会程序设计作业.docxVIP

using System; using Systcm. Collections? Generic; using System?Linq; using System? Text; namespace单像空间后方交会 { class Program { static void Main(string[] args) { int xO, yO, i, j; double f, m; Console. Write(*请输入像片比例尺：); m = double. Parse (Console. ReadLineO): Console. WriteC请输入像片的内方位元素xO:);//均以毫米为单位 xO = int. Parse (Console. ReadLineO); Console. Write(“请输入像片的内方位元素yO:); yO = int- Parse (Console. ReidLine ()); Console. WriteC请输入摄影机主距f：)； f = double ? Parse (Console .ReadLineO); Console? WriteLineO ; //输入坐标数据 doublet, ] zuobiao = now double[4, 5]; for (i = 0; i 4; i++) { for (j = 0; j 5; j++) { if (j 3) { Console. WriteCiS输入第⑹个点的第⑴个地面坐标：，i + 1, j + 1); zuobiao[i, j] = doubl c. Parse (Console .ReadLineO); } else { Console. Write(，z请输入第{0}个点的第⑴个像点坐标：,i + 1, j - 2); zuobiao[i, j] = double ? Parse (Console .ReadLineO); } } Console. WriteLineO ; ) //归算像点坐标 for (i = 0; i 4; i++) { for (j = 3; j 5; j卄) { if (j == 3) zuobiaofi, j] = zuobiao[i, j] - xO; else zuobiao[i, j] = zuobiao[i, j] - yO; } } //计算和确定初值 double zsO = m * f, xsO = 0t ysO = 0; for (i = 0; i 4; i++) xsO = xsO + zuobiao[i, 0]; ysO = ysO + zuobiaoEi, 1]; ) xsO = xsO / 4; ysO = ysO / 4; 〃逐点计算误差方程系数 doublet,] xishu = new double[8, 6]; for (i 二 0; i 8; i +二 2) { double x, y; x 二 zuobicio[i / 2, 3]; y = zuobiao[i / 2, 4]: xishu[i, 0] = xishufi + 1, 1] = -1 / m; xishufi, 1] = xishu[i 2] = -x / (in * f) ; xishu[i, 3] = -f * (1 + x * x / (f * f)); xishufi, 4] = xishu[i + 1, 3] = -x * y / f; xishu[i, 5] = y; / (m * f); xishu[i + 1, 4] = -f * (1 + y * y / (f * f)) ; xishu[i + 1, 5]=- ) 〃计算逆阵 doublet, J dMatrix =mcitrixChe(mtitrixTrcins(xishu), xishu); doublet, ] dReturn = ReverseMatrix(dMatrix, 6); Console. WriteLine(z，逆矩阵为：〃)； if (dReturn != null) { matrixOut(dReturn); } 〃求解过程 double phiO = 0, omegaO = 0t kappaO = 0; int q = 0; doublet, ] r = new double[3, 3]; doublet, ] jinsi 二 new double[4, 2]; doublet] chazhi = new double[8]; double[] jieguo = new double[6]; doublet, J zhong = matrixChc(dReturn, matrixTreins(xi