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

Rearranged init sgp4/sdp4 code order

feature/19
Daniel Warner 2011-03-27 13:58:30 +01:00
parent a23bb2b119
commit 7da1969204
1 changed files with 27 additions and 29 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

30
SGDP4.cpp
View File

@ -1,5 +1,6 @@
#include "SGDP4.h" #include "SGDP4.h"
#include "Vector.h"
#include "SatelliteException.h" #include "SatelliteException.h"
#include <math.h> #include <math.h>
@ -23,10 +24,6 @@ void SGDP4::SetTle(const Tle& tle) {
inclination_ = tle.GetField(Tle::FLD_I, Tle::U_RAD); inclination_ = tle.GetField(Tle::FLD_I, Tle::U_RAD);
mean_motion_ = tle.GetField(Tle::FLD_MMOTION) / (1440.0 / Globals::TWOPI()); mean_motion_ = tle.GetField(Tle::FLD_MMOTION) / (1440.0 / Globals::TWOPI());
bstar_ = tle.GetField(Tle::FLD_BSTAR); bstar_ = tle.GetField(Tle::FLD_BSTAR);
/*
* generate julian date for tle epoch
*/
epoch_ = tle.GetEpoch(); epoch_ = tle.GetEpoch();
/* /*
@ -61,7 +58,6 @@ void SGDP4::Initialize(const double& theta2, const double& betao2, const double&
if (Period() >= 225.0) { if (Period() >= 225.0) {
i_use_deep_space_ = true; i_use_deep_space_ = true;
} else { } else {
i_use_deep_space_ = false; i_use_deep_space_ = false;
i_use_simple_model_ = false; i_use_simple_model_ = false;
@ -138,15 +134,22 @@ void SGDP4::Initialize(const double& theta2, const double& betao2, const double&
i_aycof_ = 0.25 * i_a3ovk2_ * i_sinio_; i_aycof_ = 0.25 * i_a3ovk2_ * i_sinio_;
i_x7thm1_ = 7.0 * theta2 - 1.0; i_x7thm1_ = 7.0 * theta2 - 1.0;
if (!i_use_deep_space_) { if (i_use_deep_space_) {
i_gsto_ = Epoch().ToGMST();
double sing = sin(ArgumentPerigee());
double cosg = cos(ArgumentPerigee());
DeepSpaceInitialize(eosq, i_sinio_, i_cosio_, betao,
theta2, sing, cosg, betao2,
i_xmdot_, i_omgdot_, i_xnodot_);
} else {
double c3 = 0.0; double c3 = 0.0;
if (Eccentricity() > 1.0e-4) { if (Eccentricity() > 1.0e-4) {
c3 = coef * tsi * i_a3ovk2_ * RecoveredMeanMotion() * Globals::AE() * c3 = coef * tsi * i_a3ovk2_ * RecoveredMeanMotion() * Globals::AE() *
i_a3ovk2_ / Eccentricity(); i_a3ovk2_ / Eccentricity();
} }
i_c5_ = 2.0 * coef1 * RecoveredSemiMajorAxis() * betao2 * (1.0 + 2.75 * (etasq + eeta) + eeta * etasq); i_c5_ = 2.0 * coef1 * RecoveredSemiMajorAxis() * betao2 * (1.0 + 2.75 *
(etasq + eeta) + eeta * etasq);
i_omgcof_ = BStar() * c3 * cos(ArgumentPerigee()); i_omgcof_ = BStar() * c3 * cos(ArgumentPerigee());
i_xmcof_ = 0.0; i_xmcof_ = 0.0;
@ -155,7 +158,6 @@ void SGDP4::Initialize(const double& theta2, const double& betao2, const double&
i_delmo_ = pow(1.0 + i_eta_ * (cos(MeanAnomoly())), 3.0); i_delmo_ = pow(1.0 + i_eta_ * (cos(MeanAnomoly())), 3.0);
i_sinmo_ = sin(MeanAnomoly()); i_sinmo_ = sin(MeanAnomoly());
}
if (!i_use_simple_model_) { if (!i_use_simple_model_) {
double c1sq = i_c1_ * i_c1_; double c1sq = i_c1_ * i_c1_;
@ -170,13 +172,7 @@ void SGDP4::Initialize(const double& theta2, const double& betao2, const double&
i_t5cof_ = 0.2 * (3.0 * i_d4_ + 12.0 * i_c1_ * i_t5cof_ = 0.2 * (3.0 * i_d4_ + 12.0 * i_c1_ *
i_d3_ + 6.0 * i_d2_ * i_d2_ + 15.0 * i_d3_ + 6.0 * i_d2_ * i_d2_ + 15.0 *
c1sq * (2.0 * i_d2_ + c1sq)); c1sq * (2.0 * i_d2_ + c1sq));
} else if (i_use_deep_space_) { }
i_gsto_ = Epoch().ToGMST();
double sing = sin(ArgumentPerigee());
double cosg = cos(ArgumentPerigee());
DeepSpaceInitialize(eosq, i_sinio_, i_cosio_, betao,
theta2, sing, cosg, betao2,
i_xmdot_, i_omgdot_, i_xnodot_);
} }
first_run_ = false; first_run_ = false;
@ -436,9 +432,11 @@ void SGDP4::FindPosition(double tsince) {
double x = rk * ux * Globals::XKMPER(); double x = rk * ux * Globals::XKMPER();
double y = rk * uy * Globals::XKMPER(); double y = rk * uy * Globals::XKMPER();
double z = rk * uz * Globals::XKMPER(); double z = rk * uz * Globals::XKMPER();
Vector position(x, y, z);
double xdot = (rdotk * ux + rfdotk * vx) * Globals::XKMPER() / 60.0; double xdot = (rdotk * ux + rfdotk * vx) * Globals::XKMPER() / 60.0;
double ydot = (rdotk * uy + rfdotk * vy) * Globals::XKMPER() / 60.0; double ydot = (rdotk * uy + rfdotk * vy) * Globals::XKMPER() / 60.0;
double zdot = (rdotk * uz + rfdotk * vz) * Globals::XKMPER() / 60.0; double zdot = (rdotk * uz + rfdotk * vz) * Globals::XKMPER() / 60.0;
Vector velocity(xdot, ydot, zdot);
} }
/* /*