/// <summary> /// 计算A,B,C等参数 /// </summary> /// <param name="sinA0">sinA0</param> /// <param name="ABC">ABC数组</param> /// <param name="alpha">alpha</param> /// <param name="beta">beta</param> private void CalABC_AlphaBeta(double sinA0, double[] ABC, ref double alpha, ref double beta, ref double gama) { double cos2_A0 = 1 - sinA0 * sinA0; double k_2 = 0; double e2 = Ell.e2, b = Ell.b; double e1 = Ell.e1; k_2 = GeoPro.Getk_2(e2, cos2_A0); GeoPro.GetABC(b, k_2, ABC); alpha = GeoPro.GetAlpha(e1, cos2_A0); beta = GeoPro.GetBeta(e1, cos2_A0); gama = GeoPro.GetGama(e1, cos2_A0); }
/// <summary> /// 趋近法算角度 /// </summary> /// <param name="dL">初始经度差</param> /// <param name="cosu2">cosu2</param> /// <param name="cosu1">cosu1</param> /// <param name="ab">ab参数数组</param> /// <param name="lamda">lamda经度差估计值</param> /// <param name="A1">A1坐标方位角</param> /// <param name="del">del</param> /// <param name="cos2_A0">cos2_A0</param> /// <param name="x">x</param> private void CalA1_Lamda(double dL, double u2, double u1, double [] ab, ref double lamda, ref double A1, ref double del, ref double cos2_A0) { double deltat = 0, delta = 0; double cos_del = 0, sin_del = 0; double e1 = Ell.e1; double alpha = 0, beta = 0, gama = 0; double sinA0; double p = 0; double q = 0; lamda = dL; do { deltat = delta; p = Math.Cos(u2) * Math.Sin(lamda); q = ab[2] - ab[3] * Math.Cos(lamda); A1 = Math.Abs(Math.Atan(p / q)); A1 = GeoPro.InvJudgeA1A2(p, q, A1); sin_del = p * Math.Sin(A1) + q * Math.Cos(A1); cos_del = ab[0] + ab[1] * Math.Cos(lamda); del = Math.Atan(sin_del / cos_del); del = GeoPro.InvJudgedel(del, cos_del); sinA0 = Math.Cos(u1) * Math.Sin(A1); double del1 = Math.Atan(Math.Tan(u1) / Math.Cos(A1)); cos2_A0 = 1 - sinA0 * sinA0; alpha = GeoPro.GetAlpha(e1, cos2_A0); beta = GeoPro.GetBeta(e1, cos2_A0); gama = GeoPro.GetGama(e1, cos2_A0); delta = (alpha * del + (beta) * Math.Cos(2 * del1 + del) * Math.Sin(del) + gama * Math.Sin(2 * del) * Math.Cos(4 * del1 + 2 * del)) * sinA0; lamda = dL + delta; } while (Math.Abs(delta - deltat) * 206265 > 0.00001); }