//本影・半影の輪郭を計算する。qは角度で与えられる private static void getOutline(VesselElements ve, double l, double tan, double q, double[] result) { if (result.Length != 3) { return; } double x = 0.0; double y = 0.0; double z = 1.0; //zの初期値 double Q = q / 180 * Math.PI; double lastz = 0.0; //前のzの値 double delta = 0.0; double cos_d = Math.Cos(ve.getDeclination() / 180 * Math.PI); double sin_d = Math.Sin(ve.getDeclination() / 180 * Math.PI); double cos_d2 = cos_d * cos_d; int count = 0; while (Math.Abs(z - lastz) > 10e-7)//zが10の-7乗未満に収束しない場合ループ { lastz = z; delta = l - z * tan; x = ve.getX0() + delta * Math.Cos(Q); y = ve.getY0() + delta * Math.Sin(Q); double x2 = x * x; double y2 = y * y; z = (-Constants.e2 * y * cos_d * sin_d + Math.Sqrt((1 - Constants.e2) * (1.0 - x2 - y2 - Constants.e2 * (1.0 - x2) * cos_d2))) / (1.0 - Constants.e2 * cos_d2); if (count++ > 10) { break; //10回を超えたら強制的に打ち切り } } result[0] = x; result[1] = y; result[2] = z; }
//半影と地球外周楕円の交点を計算する public static void getCrossPoint(VesselElements ve, double[] result1, double[] result2) { if (result1.Length != 3 || result2.Length != 3) { return; } double x0 = ve.getX0(); double y0 = ve.getY0(); double l1 = ve.getL1(); double r0 = Math.Sqrt(x0 * x0 + y0 * y0); double theta = Math.Atan2(y0, x0); //ラジアン。変換しない。 double d = ve.getDeclination() / 180.0 * Math.PI; double cos_d = Math.Cos(d); double sin_d = Math.Sin(d); double E2 = (Constants.e2 * cos_d * cos_d) / (1.0 - Constants.e2 * sin_d * sin_d); double rhoplus = 1.0; //初期値 double gammaplus = 0.0; int count = 0; //正の値の近似計算 while (true) { double angle = Math.Acos((r0 * r0 + rhoplus * rhoplus - l1 * l1) / (2.0 * r0 * rhoplus)); //近似計算//正の値 if (angle < 0.0) { angle = -angle; } gammaplus = angle + theta; double newrhoplus = Math.Sqrt((1.0 - E2) / (1.0 - E2 * Math.Cos(gammaplus) * Math.Cos(gammaplus))); double dif = Math.Abs(newrhoplus - rhoplus); rhoplus = newrhoplus; if (dif < 10e-7) { break; } if (count++ > 8) { break; } } double rhominus = 1.0; double gammaminus = 0.0; count = 0; //負の値の近似計算 while (true) { double angle = Math.Acos((r0 * r0 + rhominus * rhominus - l1 * l1) / (2.0 * r0 * rhominus)); //近似計算//正の値 if (angle > 0.0) { angle = -angle; } gammaminus = angle + theta; double newrhominus = Math.Sqrt((1.0 - E2) / (1.0 - E2 * Math.Cos(gammaminus) * Math.Cos(gammaminus))); double dif = Math.Abs(newrhominus - rhominus); rhominus = newrhominus; if (dif < 10e-7) { break; } if (count++ > 8) { break; } } result1[0] = rhoplus * Math.Cos(gammaplus); result1[1] = rhoplus * Math.Sin(gammaplus); result1[2] = 0.0; result2[0] = rhominus * Math.Cos(gammaminus); result2[1] = rhominus * Math.Sin(gammaminus); result2[2] = 0.0; // System.out.println("rhoplus = " + rhoplus + " rhominus =" + rhominus); }
//食分を計算する public static void getD(VesselElements ve, double longitude, double latitude, double altitude)//, double[] result) { longitude = longitude / 180.0 * Math.PI; latitude = latitude / 180.0 * Math.PI; //測地緯度と地心緯度の差を計算 double deltalat = 3.3584196 * 0.001 * Math.Sin(2 * latitude) - 5.635 * 0.000001 * Math.Sin(4 * latitude) + 1.7 * Math.Pow(10, -8) * Math.Sin(8 * latitude); //地心直交座標を計算 double sinlat = Math.Sin(latitude); double N = 1 / Math.Sqrt(1 - Constants.e2 * sinlat * sinlat); double u = (N + altitude) * Math.Cos(latitude) * Math.Cos(longitude); double v = (N + altitude) * Math.Cos(latitude) * Math.Sin(longitude); double w = (N * (1.0 - Constants.e2) + altitude) * Math.Sin(latitude); //基準座標 double myu = ve.getMyu(); double d = ve.getDeclination(); double x = u * Math.Sin(myu) + v * Math.Cos(myu); double y = -u *Math.Cos(myu) * Math.Sin(d) + v * Math.Sin(myu) * Math.Sin(d) + w * Math.Cos(d); double z = u * Math.Cos(myu) * Math.Cos(d) - v * Math.Sin(myu) * Math.Cos(d) + w * Math.Sin(d); //r,deltaを計算する double r = Math.Sqrt(x * x + y * y + z * z); double xdiff = x - ve.getX0(); double ydiff = y - ve.getY0(); double delta = Math.Sqrt(xdiff * xdiff + ydiff * ydiff); //cosQ, sinQを計算する double cosQ = xdiff / delta; double sinQ = ydiff / delta; //月の北極方向角を計算する double tanphai = (xdiff / ydiff) + 0.0000426 * xdiff * Math.Tan(d) / (sinQ * sinQ); double moon_angle_to_northpole = Math.Atan(tanphai) / Math.PI * 180; if (moon_angle_to_northpole < 0) { moon_angle_to_northpole += 360; } else if (moon_angle_to_northpole > 360) { moon_angle_to_northpole -= 360; } if (ydiff > 0) { if (moon_angle_to_northpole > 270 | moon_angle_to_northpole < 90) { moon_angle_to_northpole += 180; } } else if (ydiff < 0) { if (moon_angle_to_northpole > 90 & moon_angle_to_northpole < 270) { moon_angle_to_northpole += 180; } } if (moon_angle_to_northpole > 360) { moon_angle_to_northpole -= 360; } //天頂の北極方位角を計算する double tannyu = x / y - delta * latitude * r * x * Math.Cos(d) / (y * y * Math.Cos(latitude)); double zenith_angle_to_northpole = Math.Atan(tannyu) / Math.PI * 180; if (zenith_angle_to_northpole < 0) { zenith_angle_to_northpole += 360; } else if (zenith_angle_to_northpole > 360) { zenith_angle_to_northpole -= 360; } if (y < 0) { if (zenith_angle_to_northpole > 270 | zenith_angle_to_northpole < 90) { zenith_angle_to_northpole += 180; } } else if (y > 0) { if (zenith_angle_to_northpole > 90 & zenith_angle_to_northpole < 270) { zenith_angle_to_northpole += 180; } } if (zenith_angle_to_northpole > 360) { zenith_angle_to_northpole -= 360; } double omega = moon_angle_to_northpole - zenith_angle_to_northpole; if (Math.Abs(omega) > 180) { if (omega < 0) { omega += 360; } else if (omega > 0) { omega -= 360; } } //omega = omega / Math.PI * 180.0; // Debug.Log("omega= " + omega); //食分を求める double D = (ve.getL1() - z * ve.getTanf1() - delta) / (ve.getL1() + ve.getL2() - z * (ve.getTanf1() + ve.getTanf2())); //debug /* * Debug.Log("deltalat = " + deltalat); * Debug.Log("x0 = "+ ve.getX0()); * Debug.Log("y0 = " + ve.getY0()); * Debug.Log("d = " + (ve.getDeclination() / Math.PI * 180.0)); * Debug.Log("l1 = " + ve.getL1()); * Debug.Log("l2 = " + ve.getL2()); * Debug.Log("tanf1 = " + ve.getTanf1()); * Debug.Log("tanf2 = " + ve.getTanf2()); * Debug.Log("myu = " + myu); * Debug.Log("x = " + x); * Debug.Log("y = " + y); * Debug.Log("z = " + z); * Debug.Log("r = " + r); * Debug.Log("delta = " + delta); * Debug.Log("sinQ = " + sinQ); * Debug.Log("(x - x0)/ (y - y0) = " + (xdiff / ydiff)); * Debug.Log("pais(x-x0)tan(d) / sin2 Q = " + (0.0000426 * xdiff * Math.Tan(d) / (sinQ * sinQ))); * Debug.Log("Tan(phai) = " + tanphai); * Debug.Log("phai = " + moon_angle_to_northpole); * Debug.Log("x / y = " + (x / y)); * Debug.Log("delta phai = " + (delta * latitude * r * x * Math.Cos(d) / (y * y * Math.Cos(latitude)))); * Debug.Log("tan(nyu) = " + tannyu); * Debug.Log("nyu = " + zenith_angle_to_northpole); * Debug.Log("omega = " + omega); * Debug.Log("D=" + D); */ //debug終わり }
public static void transformICRStoGCS(VesselElements ve, double[] point, double[] result) { if (result.Length != 2) { return; } double d = ve.getDeclination();//ラジアン //変換行列を生成(縦配置) double[][] transmatrix = new double[][] { new double[3], new double[3], new double[3] }; double[] coordinate1 = new double[] { point[0], point[1], point[2] }; double[] coordinate2 = new double[3]; double angle = d - (Math.PI / 2.0); transmatrix[0][0] = 1.0; transmatrix[0][1] = 0.0; transmatrix[0][2] = 0.0; transmatrix[1][0] = 0.0; transmatrix[1][1] = Math.Cos(angle); transmatrix[1][2] = -Math.Sin(angle); transmatrix[2][0] = 0.0; transmatrix[2][1] = Math.Sin(angle); transmatrix[2][2] = Math.Cos(angle); Matrix.multiplication31type2(transmatrix, coordinate1, coordinate2); angle = (ve.getGreenidgeSiderealTime() / 180.0 * Math.PI) - ve.getAscension() - (Math.PI / 2.0); transmatrix[0][0] = Math.Cos(angle); transmatrix[0][1] = -Math.Sin(angle); transmatrix[0][2] = 0.0; transmatrix[1][0] = Math.Sin(angle); transmatrix[1][1] = Math.Cos(angle); transmatrix[1][2] = 0.0; transmatrix[2][0] = 0.0; transmatrix[2][1] = 0.0; transmatrix[2][2] = 1.0; Matrix.multiplication31type2(transmatrix, coordinate2, coordinate1); result[0] = Math.Atan2(coordinate1[1], coordinate1[0]) / Math.PI * 180.0; //経度 //緯度を求める double denominator = Math.Sqrt(coordinate1[0] * coordinate1[0] + coordinate1[1] * coordinate1[1]); //root(u* u + v* v); double coequation1 = coordinate1[2] / denominator; double coequation2 = Constants.e2 / denominator; double tan_phai = coequation1; double lasttan_phai = -tan_phai;//tan_phaiと一致させないための工夫。 int count = 0; while (Math.Abs(tan_phai - lasttan_phai) > 10e-7) { lasttan_phai = tan_phai; tan_phai = coequation1 + coequation2 * (lasttan_phai / Math.Sqrt(1.0 + (1.0 - Constants.e2) * lasttan_phai * lasttan_phai)); if (count++ > 10) { break; } } result[1] = Math.Atan(tan_phai) / Math.PI * 180.0; //緯度 }