//确定外方位元素的初始值

//1.确定Xs的初始值： double Xs0 = 0; double sumx = 0;

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

double h = arr2[j, 0]; sumx += h;

}

Xs0 = sumx / n; //2.确定Ys的初始值： double Ys0 = 0; double sumy = 0;

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

double h = arr2[j, 1]; sumy += h;

}

Ys0 = sumy / n; //3.确定Zs的初始值： double Zs0 = 0; double sumz = 0;

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

double h = arr2[j, 2]; sumz += h;

}

Zs0 = sumz / n; double Φ0 = 0; double Ψ0 = 0; double K0 = 0;

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

//用三个角元素的初始值按（3-4-5）计算各方向余弦值，组成旋转矩阵,此时的旋转矩阵为单位矩阵I：

double[,] arr3 = new double[3, 3]; for (int i = 0; i < 3; i++)