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

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];