单像空间后方交会

temp[l, p] = 0; }

////把ATA各值赋给temp for (int i = 0; i < 6; i++)

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

temp[i, j] = ATA[i, j]; }

////在temp中加入初等方阵 for (int l = 0; l < 6; l++) temp[l, l + 6] = 1; ////初等变换

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

if (temp[l, l] != 1) {

double bs = temp[l, l]; temp[l, l] = 1;

for (int p = l + 1; p < 12; p++) temp[l, p] /= bs; }

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

if (q != l) {

double bs = temp[q, l]; for (int p = l; p < 12; p++)

temp[q, p] -= bs * temp[l, p]; } else

continue; } }

////得到ATA的逆阵后存在ATAR中 for (int i = 0; i < 6; i++)

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

ATAR[i, j] = temp[i, j + 6]; }

////ATAR * AT存在ATARAT中 for (int i = 0; i < 6; i++)

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

ATARAT[i, j] = 0;

for (int l = 0; l < 6; l++)

ATARAT[i, j] += ATAR[i, l] * AT[l, j]; }

////计算ATARAT * L，存在XX中 for (int i = 0; i < 6; i++)

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

迭代结果.txt\

\

\

XX[i, j] = 0;

for (int l = 0; l < 8; l++)

XX[i, j] += ATARAT[i, l] * L[l, 0]; }

////计算外方位元素值 Xs += XX[0, 0]; Ys += XX[1, 0]; Zs += XX[2, 0]; φ += XX*3, 0+; ω += XX*4, 0+; κ += XX*5, 0+; if (n > c_N)

Console.Write(\超过迭代精度，此数值下可能不收敛！\else {

StreamWriter mystreamwriter = File.AppendText(\ mystreamwriter.WriteLine(\迭代次数：\ mystreamwriter.WriteLine(\

mystreamwriter.WriteLine(\ mystreamwriter.WriteLine(\ mystreamwriter.WriteLine(\ mystreamwriter.WriteLine(\

mystreamwriter.WriteLine(\ mystreamwriter.WriteLine(\ mystreamwriter.WriteLine(\ mystreamwriter.WriteLine(\

mystreamwriter.WriteLine(\ mystreamwriter.WriteLine(\+ XX[1, 0].ToString() + mystreamwriter.WriteLine(\

\

mystreamwriter.WriteLine(\+ XX*3, 0+.ToString() + \

mystreamwriter.WriteLine(\+ XX*4, 0+.ToString() + \

mystreamwriter.WriteLine(\+ XX*5, 0+.ToString() + \

mystreamwriter.WriteLine(\ mystreamwriter.Close(); } n++; }

while (Math.Abs(XX[0, 0]) >= d || Math.Abs(XX[1, 0]) >= d || Math.Abs(XX[2, 0]) >= d || Math.Abs(XX[3, 0]) >= 1000 * d || Math.Abs(XX[4, 0]) >= 1000 * d || Math.Abs(XX[5, 0]) >= 1000 * d);

Console.Write(\迭代结果保存在E:\\\\迭代结果.txt\\n\ Console.ReadLine(); } } }

迭代结果 计算结果：

比例尺m=26428.5803527275 航高H=743.591893946307

迭代次数：1

Xs:499427.235480172m Ys:4186554.35263872m Zs:1368.80576213753m

φ:1.69692876951611rad ω:-2.09012267498615rad κ:0.00548008783721364rad

dXs:-788.254519827722m dYs:1252.46263871879m dZs:-106.754237862473m

dφ:1.64204676951611rad dω:-2.14715667498615rad dκ:0.0416550878372136rad

迭代次数：2

Xs:500467.532419656m Ys:4185456.61453054m Zs:374.95743717003m

φ:-0.140958561770875rad ω:-2.23441990062963rad κ:-2.17405022753397rad

dXs:1040.29693948375m dYs:-1097.73810818188m dZs:-993.848324967497m dφ:-1.83788733128699rad dω:-0.144297225643471rad dκ:-2.17953031537119rad

迭代次数：3

Xs:500476.308776212m Ys:4185607.38026842m Zs:632.838706698654m

φ:0.954363844863929rad ω:-2.48825187782244rad κ:-1.75495905958627rad

dXs:8.77635655598289m dYs:150.76573788617m dZs:257.881269528624m dφ:1.0953224066348rad dω:-0.253831977192816rad