摄影测量学空间后方交会实验报告(2)

for (int j = 0; j < 6; j++) {

arr5AA[i, j] = 0;

for (int l = 0; l < 2 * n; l++) {

arr5AA[i, j] += arr5T[i, l] * arr5[l, j]; } } }

nijuzhen(arr5AA);

//arr5AA经过求逆后变成原矩阵的逆矩阵 //arr5AA * arr5T存在arr5AARAT

double[,] arr5AARAT = new double[6, 2 * n];

for (int i = 0; i < 6; i++) {

for (int j = 0; j < 2 * n; j++)

{

arr5AARAT[i, j] = 0; for (int p = 0; p < 6; p++) {

arr5AARAT[i, j] += arr5AA[i, p] * arr5T[p, j]; } } }

//计算arr5AARAT x L，存在arrX中 double[] arrX = new double[6]; for (int i = 0; i < 6; i++) {

for (int j = 0; j < 1; j++) {

arrX[i] = 0;

for (int vv = 0; vv < 6; vv++) {

arrX[i] += arr5AARAT[i, vv] * arr7[vv]; } } }

//计算外方位元素值

double Xs, Ys, Zs, Φ, Ψ, K; Xs = Xs0 + arrX[0]; Ys = Ys0 + arrX[1]; Zs = Zs0 + arrX[2]; Φ = Φ0 + arrX[3]; Ψ = Ψ0 + arrX[4]; K = K0 + arrX[5];

for (int i = 0; i <= 2; i++) {

Xs += arrX[0]; Ys += arrX[1]; Zs += arrX[2]; Φ += arrX[3]; Ψ += arrX[4]; K += arrX[5]; }

Console.WriteLine("Xs,Ys,Zs,Φ,Ψ,K的值分别是：{0},{1},{2},{3},{4},{5}", Xs0, Ys0, Zs0, Φ, Ψ, K);

Console.Read();

}

//求arr5AA的逆矩

public static double[,] nijuzhen(double[,] a) {

double[,] B = new double[6, 6]; int i, j, k; int row = 0; int col = 0; double max, temp; int[] p = new int[6]; for (i = 0; i < 6; i++) {

p[i] = i; B[i, i] = 1; }

for (k = 0; k < 6; k++) {

//找主元

max = 0; row = col = i; for (i = k; i < 6; i++) {

for (j = k; j < 6; j++) {

temp = Math.Abs(a[i, j]); if (max < temp) {

max = temp; row = i; col = j; } } }

//交换行列，将主元调整到k行k列上 if (row != k) {

for (j = 0; j < 6; j++) {

temp = a[row, j]; a[row, j] = a[k, j]; a[k, j] = temp; temp = B[row, j]; B[row, j] = B[k, j]; B[k, j] = temp;

i = p[row]; p[row] = p[k]; p[k] = i; }

if (col != k) {

for (i = 0; i < 6; i++) {

temp = a[i, col]; a[i, col] = a[i, k]; a[i, k] = temp; } } //处理

for (j = k + 1; j < 6; j++) {

a[k, j] /= a[k, k]; }

for (j = 0; j < 6; j++) {

B[k, j] /= a[k, k]; a[k, k] = 1; }

for (j = k + 1; j < 6; j++) {

for (i = 0; j < k; i++) {

a[i, j] -= a[i, k] * a[k, j];

}

for (i = k + 1; i < 6; i++) {

a[i, j] -= a[i, k] * a[k, j]; } }

for (j = 0; j < 6; j++) {

for (i = 0; i < k; i++) {

B[i, j] -= a[i, k] * B[k, j];

}

for (i = k + 1; i < 6; i++) {

B[i, j] -= a[i, k] * B[k, j];

}

for (i = 0; i < 6; i++) {

a[i, k] = 0; a[k, k] = 1; } }

//恢复行列次序

for (j = 0; j < 6; j++) {

for (i = 0; i < 6; i++) {

a[p[i], j] = B[i, j]; } }

for (i = 0; i < 6; i++) {

for (j = 0; j < 6; j++) {

a[i, j] = a[i, j]; } }

return a; }

4．实验结果

四．实验总结

此次实验让我深入了解单像空间后方交会的计算过程，加强了对空间后方交会基本公式和误差方程式，法线方程式的记忆。并通过上机调试程序加强了自己动手能力的培养。通过此次实验为以后的摄影测量学的学习打下了基础。