摄影测量后方交会法求解外方位元素.docxVIP

摄影测量后方交会求外方位元素 09地信一班肖明梅 解题思路：定义要用到的变量并初始化，定义一个函数用于求解旋转矩阵R,系 数矩阵A,近似坐标矩阵JSZB,常数矩阵L;雉阵的转置，逆，矩阵相乘，相减，求 外方位元素的近似值初值以及结果输出都定义为相应的函数。最后定义一个用于 循环求解的函数(程序中xhqiujie()),在该函数中调用之前定义的函数，求出外 方位元素近似值初值，改正数Dv[6,l],误差用do-whilc语句进行循环, 使精度达到20 um,限差低于20 um,然后调用结果输出函数用于输出达到要求 的结果。在主函数中创建对象的实例，引用该实例的方法即xhqiujie()函数，就 可以求出外方位元素。 代码： using System; using System.Collections.Generic; using System.Linq; using System.Text; namespace摄影测量后方交会求外方位元素 { class Program { double 屮，co, k, Xs, Ys, Zs, m, f, Sx = 0, Sy = 0; double n = 206265 / 3600;//*角元素的单位从m到度的转换系数*〃 double],] zuobiao = {{ -86.15,?53.40, -14.78, 10.46 }, {-68.99, 82.21/76.63,64.43},{36589.41,37631.039100.97,40426.54},{ 25273.32,31324.51,2 4934.930319.81 },{ 2195.17,7269,2386.50,757.31 }}; double[] a = new double[3];//*存储 al,a2.a3*〃 double[] b = new double[3];//*存储 bl,b2,b3*〃 doublc[] c = new double[3];//*存储 cl,c2,c3*〃 double[] XX = new double[4J; double[] YY = new double[4]; double[] ZZ = new double[4J; double[,] L = new double[8, 1]; double[,] JSZB = new double[2, 4];//*像点近似坐标*// doublet,] A = new double[ 6];//*系数阵*// double[,] AT = new double[6, 8]; double[J AB = new double[6, 6]; double[,] AN = new double[6, 6]; double[,] AL = new double[6, 1]; doublet,] Dv = new double[6, 1]; double[,] AX = new double[ 1];//*系数阵与改止数矩阵的乘积*〃 doublc[,] V = new doublc[ 1];//*中课差矩阵*〃 private void Qchuzhi() { for (int i = 0; i 4; i++) { Sx += zuobiao[2, i]; } for (int i = 0; i 4; i++) { Sy += zuobiao[3, i]; } for (int i = 0; i 4; i++) { zuobiao[0, i] = zuobiao[0, i] / 1000; zuobiao[l, i] = zuobiao[l, i] / 1000; } //*求外方位元素初始值*〃 l|/ = CO = K = 0； m = 50000; f= 0.15324; Xs = Sx / 4; Ys = Sy / 4; Zs = m * f; 〃*求旋转矩阵R,像点坐标近似值，常数项矩阵L,系数矩阵A*// private void R() { 〃旋转矩阵R a[0] = Math.Cos(屮)* Math.Cos(K)- Math.Sing) * Math.Sin(co) * Math.Sin(K); a[l] = -Math.Cos(\|/) * Math.Sin(K)? Math.Sin(\|/) * Math.Sin(co) * Math?Cos(K); a[2] = -Math.Sin(屮)* Math.Cos(o); b[0] = Math.Cos(co) * Math.Sin(K); b[l] = Math.Cos(co) * Math.Cos(K); b[2] = -Math.Sin(co); c[0] = M