]> git.mxchange.org Git - flightgear.git/blob - Astro/celestialBody.cxx
math domain error fix from Charlie Hotchkiss.
[flightgear.git] / Astro / celestialBody.cxx
1 /**************************************************************************
2  * celestialBody.cxx
3  * Written by Durk Talsma. Originally started October 1997, for distribution  
4  * with the FlightGear project. Version 2 was written in August and 
5  * September 1998. This code is based upon algorithms and data kindly 
6  * provided by Mr. Paul Schlyter. (pausch@saaf.se). 
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of the
11  * License, or (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful, but
14  * WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
16  * General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21  *
22  * $Id$
23  * (Log is kept at end of this file)
24  **************************************************************************/
25
26 #include "celestialBody.hxx"
27 #include "star.hxx"
28 #include <Debug/logstream.hxx>
29
30 #ifdef FG_MATH_EXCEPTION_CLASH
31 #  define exception c_exception
32 #endif
33 #include <math.h>
34
35 /**************************************************************************
36  * void CelestialBody::updatePosition(fgTIME *t, Star *ourSun)
37  *
38  * Basically, this member function provides a general interface for 
39  * calculating the right ascension and declinaion. This function is 
40  * used for calculating the planetary positions. For the planets, an 
41  * overloaded member function is provided to additionally calculate the
42  * planet's magnitude. 
43  * The sun and moon have their own overloaded updatePosition member, as their
44  * position is calculated an a slightly different manner.  
45  *
46  * arguments:
47  * fgTIME t: provides the current time.
48  * Star *ourSun: the sun's position is needed to convert heliocentric 
49  *               coordinates into geocentric coordinates.
50  *
51  * return value: none
52  *
53  *************************************************************************/
54 void CelestialBody::updatePosition(fgTIME *t, Star *ourSun)
55 {
56   double eccAnom, v, ecl, actTime, 
57     xv, yv, xh, yh, zh, xg, yg, zg, xe, ye, ze;
58
59   updateOrbElements(t);
60   actTime = fgCalcActTime(t);
61
62   // calcualate the angle bewteen ecliptic and equatorial coordinate system
63   ecl = DEG_TO_RAD * (23.4393 - 3.563E-7 *actTime);
64   
65   eccAnom = fgCalcEccAnom(M, e);  //calculate the eccentric anomaly
66   xv = a * (cos(eccAnom) - e);
67   yv = a * (sqrt (1.0 - e*e) * sin(eccAnom));
68   v = atan2(yv, xv);           // the planet's true anomaly
69   r = sqrt (xv*xv + yv*yv);    // the planet's distance
70   
71   // calculate the planet's position in 3D space
72   xh = r * (cos(N) * cos(v+w) - sin(N) * sin(v+w) * cos(i));
73   yh = r * (sin(N) * cos(v+w) + cos(N) * sin(v+w) * cos(i));
74   zh = r * (sin(v+w) * sin(i));
75
76   // calculate the ecliptic longitude and latitude
77   xg = xh + ourSun->getxs();
78   yg = yh + ourSun->getys();
79   zg = zh;
80   
81   xe = xg;
82   ye = yg * cos(ecl) - zg * sin(ecl);
83   ze = yg * sin(ecl) + zg * cos(ecl);
84   rightAscension = atan2(ye, xe);
85   declination = atan2(ze, sqrt(xe*xe + ye*ye));
86   FG_LOG(FG_GENERAL, FG_INFO, "Planet found at : " 
87          << rightAscension << " (ra), " << declination << " (dec)" );
88
89   //calculate some variables specific to calculating the magnitude 
90   //of the planet
91   R = sqrt (xg*xg + yg*yg + zg*zg);
92   s = ourSun->getDistance();
93
94   // It is possible from these calculations for the argument to acos
95   // to exceed the valid range for acos(). So we do a little extra
96   // checking.
97
98   double tmp = (r*r + R*R - s*s) / (2*r*R);
99   if ( tmp > 1.0) { 
100       tmp = 1.0;
101   } else if ( tmp < -1.0) {
102       tmp = -1.0;
103   }
104
105   FV = RAD_TO_DEG * acos( tmp );
106 };
107
108 /****************************************************************************
109  * double CelestialBody::fgCalcEccAnom(double M, double e)
110  * this private member calculates the eccentric anomaly of a celestial body, 
111  * given its mean anomaly and eccentricity.
112  * 
113  * -Mean anomaly: the approximate angle between the perihelion and the current
114  *  position. this angle increases uniformly with time.
115  *
116  * True anomaly: the actual angle between perihelion and current position.
117  *
118  * Eccentric anomaly: this is an auxilary angle, used in calculating the true
119  * anomaly from the mean anomaly.
120  * 
121  * -eccentricity. Indicates the amount in which the orbit deviates from a 
122  *  circle (0 = circle, 0-1, is ellipse, 1 = parabola, > 1 = hyperbola).
123  *
124  * This function is also known as solveKeplersEquation()
125  *
126  * arguments: 
127  * M: the mean anomaly
128  * e: the eccentricity
129  *
130  * return value:
131  * the eccentric anomaly
132  *
133  ****************************************************************************/
134 double CelestialBody::fgCalcEccAnom(double M, double e)
135 {
136   double 
137     eccAnom, E0, E1, diff;
138   
139   eccAnom = M + e * sin(M) * (1.0 + e * cos (M));
140   // iterate to achieve a greater precision for larger eccentricities 
141   if (e > 0.05)
142     {
143       E0 = eccAnom;
144       do
145         {
146           E1 = E0 - (E0 - e * sin(E0) - M) / (1 - e *cos(E0));
147           diff = fabs(E0 - E1);
148           E0 = E1;
149         }
150       while (diff > (DEG_TO_RAD * 0.001));
151       return E0;
152     }
153   return eccAnom;
154 }
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169