Elliptic_integrals.cpp 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125
  1. #include "Elliptic_integrals.h"
  2. // std::string Error()
  3. // {
  4. // std::string mes = "Error! k should be from -1 to 1";
  5. // std::exception(mes);
  6. // }
  7. /**
  8. * Purpose: Constructor
  9. *
  10. * @return None
  11. * @throws None
  12. */
  13. Elliptic_Integrals::Elliptic_Integrals()
  14. {
  15. }
  16. /**
  17. * Purpose: Destructor
  18. *
  19. * @return None
  20. * @throws None
  21. */
  22. Elliptic_Integrals::~Elliptic_Integrals()
  23. {
  24. }
  25. /**
  26. * Purpose: Compute elliptic integrals F(phi, k) and E(phi, k)
  27. *
  28. * @param k - modulus k (-1 <= k <= 1)
  29. * @param phi - argument (in degrees), 0 <= phi <= 90
  30. * @return Vector with values of F(phi, k)) (the first place) and E(phi, k) (the second place)
  31. * @throws "Error! k should be from -1 to 1"
  32. */
  33. std::vector<double> Elliptic_Integrals::Elliptic(const double phi, const double k)
  34. {
  35. std::vector<double> result;
  36. if ((phi > 90) || (phi < 0))
  37. {
  38. std::cerr << "Parameter phi must be in the range [0, 90]" << std::endl;
  39. return result;
  40. }
  41. if ((k > 1) || (k < -1))
  42. {
  43. std::cerr << "Parameter k must be in the range [-1, 1]" << std::endl;
  44. return result;
  45. }
  46. double G = 0.0;
  47. double pi = M_PI;
  48. double A0 = 1.0;
  49. double B0 = sqrt(1.0 - k * k);
  50. double D0 = pi / 180.0 * phi;
  51. double R = k * k;
  52. if (k == 1 and phi == 90)
  53. {
  54. double FE = std::numeric_limits<double>::infinity();
  55. double EE = 1.0;
  56. result.push_back(FE);
  57. result.push_back(EE);
  58. }
  59. else if (k == 1)
  60. {
  61. double FE = log((1.0 + sin(D0)) / cos(D0));
  62. double EE = sin(D0);
  63. result.push_back(FE);
  64. result.push_back(EE);
  65. }
  66. else
  67. {
  68. double FAC = 1.0;
  69. double A;
  70. double B;
  71. double C;
  72. double D;
  73. for (int k = 1; k <= 1000; k++)
  74. {
  75. A = (A0 + B0) / 2.0;
  76. B = sqrt(A0 * B0);
  77. C = (A0 - B0) / 2.0;
  78. FAC = 2.0 * FAC;
  79. R = R + FAC * C * C;
  80. if (phi != 90)
  81. {
  82. D = D0 + atan((B0 / A0) * tan(D0));
  83. G = G + C * sin(D);
  84. D0 = D + pi * int(D / pi + 0.5);
  85. }
  86. A0 = A;
  87. B0 = B;
  88. if (C < 1e-7) goto stop;
  89. continue;
  90. }
  91. stop:
  92. double CK = pi / (2.0 * A);
  93. double CE = pi * (2.0 - R) / (4.0 * A);
  94. if (phi == 90)
  95. {
  96. double FE = CK;
  97. double EE = CE;
  98. result.push_back(FE);
  99. result.push_back(EE);
  100. }
  101. else
  102. {
  103. double FE = D / (FAC * A);
  104. double EE = FE * CE / CK + G;
  105. result.push_back(FE);
  106. result.push_back(EE);
  107. }
  108. }
  109. return result;
  110. }