KJ135
/
sgp4
mirror of http://172.16.0.12:5000/LAMPSARToolSoftware/sgp4.git
4
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

SatelliteException check elsq >= 1.0

feature/19
Daniel Warner 2011-03-27 13:28:36 +01:00
parent 9dfe22060b
commit 2a7760db23
1 changed files with 15 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

17
SGDP4.cpp
View File

@ -272,6 +272,7 @@ void SGDP4::FindPosition(double tsince) {
double aynl;
double xlt;
double ayn;
double elsq;
{
axn = tsince_eccentricity * cos(tsince_arg_perigee);
double temp1 = 1.0 / (a * beta * beta);
@ -279,9 +280,20 @@ void SGDP4::FindPosition(double tsince) {
aynl = temp1 * aycof_;
xlt = xl + xll;
ayn = tsince_eccentricity * sin(tsince_arg_perigee) + aynl;
elsq = axn * axn + ayn * ayn;
}
if (elsq >= 1.0) {
throw new SatelliteException("Error: sqrt(e) >= 1 (elsq >= 1.0)");
}
/*
* solve keplers equation
* - solve using Newton-Raphson root solving
* - here capu is almost the mean anomoly
* - initialise the eccentric anomaly term epw
* - The fmod saves reduction of angle to +/-2pi in sin/cos() and prevents
* convergence problems.
*/
double capu = fmod(xlt - xnode, Globals::TWOPI());
double epw = capu;
@ -292,9 +304,9 @@ void SGDP4::FindPosition(double tsince) {
double esine = 0.0;
/*
* todo
* sensibility check for N-R correction
*/
double maxnr = Eccentricity();
double maxnr = sqrt(elsq);
bool kepler_running = true;
@ -383,6 +395,7 @@ void SGDP4::FindPosition(double tsince) {
if (rk < 0.0) {
throw new SatelliteException("Error: satellite decayed (rk < 0.0)");
}
/*
* orientation vectors
*/