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

FinalPosition calls DeepPeriodic

feature/19
Daniel Warner 2011-03-27 00:21:36 +00:00
parent 5be4fc2389
commit 26d5a6c1de
2 changed files with 24 additions and 48 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

60
SGDP4.cpp
View File

@ -211,17 +211,10 @@ void SGDP4::Initialize(const double& theta2, const double& betao2, const double&
void SGDP4::FindPosition(double tsince) { void SGDP4::FindPosition(double tsince) {
struct TleData tle_data_tsince_; double tsince_eccentricity = Eccentricity();
memset(&tle_data_tsince_, 0, sizeof (tle_data_tsince_)); double tsince_arg_perigee = ArgumentPerigee();
double tsince_inclination = Inclination();
tle_data_tsince_.bstar = BStar(); double tsince_ascending_node = AscendingNode();
tle_data_tsince_.eo = Eccentricity();
tle_data_tsince_.omega = ArgumentPerigee();
tle_data_tsince_.xincl = Inclination();
tle_data_tsince_.xmo = MeanAnomoly();
tle_data_tsince_.xno = RecoveredMeanMotion();
tle_data_tsince_.xnodeo = AscendingNode();
tle_data_tsince_.epoch = Epoch();
double xl = 0.0; double xl = 0.0;
double a = 0.0; double a = 0.0;
@ -231,34 +224,35 @@ void SGDP4::FindPosition(double tsince) {
*/ */
double xmdf = MeanAnomoly() + xmdot_ * tsince; double xmdf = MeanAnomoly() + xmdot_ * tsince;
double omgadf = ArgumentPerigee() + omgdot_ * tsince; double omgadf = ArgumentPerigee() + omgdot_ * tsince;
double xnoddf = tle_data_tsince_.xnodeo + xnodot_ * tsince; double xnoddf = tsince_ascending_node + xnodot_ * tsince;
double tsq = tsince * tsince; double tsq = tsince * tsince;
double xnode = xnoddf + xnodcf_ * tsq; double xnode = xnoddf + xnodcf_ * tsq;
double tempa = 1.0 - c1_ * tsince; double tempa = 1.0 - c1_ * tsince;
double tempe = tle_data_tsince_.bstar * c4_ * tsince; double tempe = BStar() * c4_ * tsince;
double templ = t2cof_ * tsq; double templ = t2cof_ * tsq;
tle_data_tsince_.omega = omgadf; tsince_arg_perigee = omgadf;
if (use_deep_space_) { if (use_deep_space_) {
double xn = RecoveredMeanMotion(); double xn = RecoveredMeanMotion();
#if 0 #if 0
CALL DPSEC(xmdf, tle_data_tsince_.omega, XNODE, tle_data_tsince_.eo, tle_data_tsince_.xincl, xn, tsince); CALL DPSEC(xmdf, tsince_arg_perigee, XNODE, tle_data_tsince_.eo, tsince_inclination, xn, tsince);
#endif #endif
a = pow(Globals::XKE() / xn, Globals::TOTHRD()) * pow(tempa, 2.0); a = pow(Globals::XKE() / xn, Globals::TOTHRD()) * pow(tempa, 2.0);
tle_data_tsince_.eo -= tempe; tsince_eccentricity -= tempe;
double xmam = xmdf + RecoveredMeanMotion() * templ; double xmam = xmdf + RecoveredMeanMotion() * templ;
#if 0
CALL DPPER(tle_data_tsince_.eo, tle_data_tsince_.xincl, tle_data_tsince_.omega, tle_data_tsince_.xnodeo, xmam); DeepPeriodics(sinio_, cosio_, tsince, tsince_eccentricity,
#endif tsince_inclination, tsince_arg_perigee, tsince_ascending_node, xmam);
xl = xmam + tle_data_tsince_.omega + xnode;
xl = xmam + tsince_arg_perigee + xnode;
/* /*
* re-compute the perturbed values * re-compute the perturbed values
*/ */
sinio_ = sin(tle_data_tsince_.xincl); sinio_ = sin(tsince_inclination);
cosio_ = cos(tle_data_tsince_.xincl); cosio_ = cos(tsince_inclination);
double theta2 = cosio_ * cosio_; double theta2 = cosio_ * cosio_;
@ -280,19 +274,19 @@ void SGDP4::FindPosition(double tsince) {
double delm = xmcof_ * (pow(1.0 + eta_ * cos(xmdf), 3.0) - delmo_); double delm = xmcof_ * (pow(1.0 + eta_ * cos(xmdf), 3.0) - delmo_);
double temp1 = delomg + delm; double temp1 = delomg + delm;
xmp = xmdf + temp1; xmp = xmdf + temp1;
tle_data_tsince_.omega -= temp1; tsince_arg_perigee -= temp1;
double tcube = tsq * tsince; double tcube = tsq * tsince;
double tfour = tsince * tcube; double tfour = tsince * tcube;
tempa -= d2_ * tsq - d3_ * tcube - d4_ * tfour; tempa -= d2_ * tsq - d3_ * tcube - d4_ * tfour;
tempe += tle_data_tsince_.bstar * c5_ * (sin(xmp) - sinmo_); tempe += BStar() * c5_ * (sin(xmp) - sinmo_);
templ += t3cof_ * tcube + tfour * (t4cof_ + tsince * t5cof_); templ += t3cof_ * tcube + tfour * (t4cof_ + tsince * t5cof_);
} }
a = RecoveredSemiMajorAxis() * pow(tempa, 2.0); a = RecoveredSemiMajorAxis() * pow(tempa, 2.0);
tle_data_tsince_.eo = Eccentricity() - tempe; tsince_eccentricity = Eccentricity() - tempe;
xl = xmp + tle_data_tsince_.omega + xnode + RecoveredMeanMotion() * templ; xl = xmp + tsince_arg_perigee + xnode + RecoveredMeanMotion() * templ;
} }
double beta = sqrt(1.0 - tle_data_tsince_.eo * tle_data_tsince_.eo); double beta = sqrt(1.0 - tsince_eccentricity * tsince_eccentricity);
double xn = Globals::XKE() / pow(a, 1.5); double xn = Globals::XKE() / pow(a, 1.5);
/* /*
* long period periodics * long period periodics
@ -303,12 +297,12 @@ void SGDP4::FindPosition(double tsince) {
double xlt; double xlt;
double ayn; double ayn;
{ {
axn = tle_data_tsince_.eo * cos(tle_data_tsince_.omega); axn = tsince_eccentricity * cos(tsince_arg_perigee);
double temp1 = 1.0 / (a * beta * beta); double temp1 = 1.0 / (a * beta * beta);
xll = temp1 * xlcof_ * axn; xll = temp1 * xlcof_ * axn;
aynl = temp1 * aycof_; aynl = temp1 * aycof_;
xlt = xl + xll; xlt = xl + xll;
ayn = tle_data_tsince_.eo * sin(tle_data_tsince_.omega) + aynl; ayn = tsince_eccentricity * sin(tsince_arg_perigee) + aynl;
} }
/* /*
* solve keplers equation * solve keplers equation
@ -391,7 +385,7 @@ void SGDP4::FindPosition(double tsince) {
rk = r * (1.0 - 1.5 * temp3 * betal * x3thm1_) + 0.5 * temp2 * x1mth2_ * cos2u; rk = r * (1.0 - 1.5 * temp3 * betal * x3thm1_) + 0.5 * temp2 * x1mth2_ * cos2u;
uk = u - 0.25 * temp3 * x7thm1_ * sin2u; uk = u - 0.25 * temp3 * x7thm1_ * sin2u;
xnodek = xnode + 1.5 * temp3 * cosio_ * sin2u; xnodek = xnode + 1.5 * temp3 * cosio_ * sin2u;
xinck = tle_data_tsince_.xincl + 1.5 * temp3 * cosio_ * sinio_ * cos2u; xinck = tsince_inclination + 1.5 * temp3 * cosio_ * sinio_ * cos2u;
rdotk = rdot - xn * temp2 * x1mth2_ * sin2u; rdotk = rdot - xn * temp2 * x1mth2_ * sin2u;
rfdotk = rfdot + xn * temp2 * (x1mth2_ * cos2u + 1.5 * x3thm1_); rfdotk = rfdot + xn * temp2 * (x1mth2_ * cos2u + 1.5 * x3thm1_);
} }
@ -423,12 +417,6 @@ void SGDP4::FindPosition(double tsince) {
double zdot = (rdotk * uz + rfdotk * vz) * Globals::XKMPER() / 60.0; double zdot = (rdotk * uz + rfdotk * vz) * Globals::XKMPER() / 60.0;
} }
/*
* variable used
* func DPINIT(EQSQ,SINIQ,COSIQ,RTEQSQ,theta2,sing,cosg,betao2,XLLDOT,OMGDT, XNODOT)
* call DPINIT(EOSQ,SINIO,COSIO,BETAO, THETA2,SING,COSG,BETAO2,XMDOT, OMGDOT,XNODOT)
*/
/* /*
* deep space initialization * deep space initialization
*/ */

12
SGDP4.h
View File

@ -9,20 +9,8 @@ public:
virtual ~SGDP4(void); virtual ~SGDP4(void);
void SetTle(const Tle& tle); void SetTle(const Tle& tle);
void FindPosition(double tsince); void FindPosition(double tsince);
struct TleData {
double bstar;
double eo;
double omega;
double xincl;
double xmo;
double xno;
double xnodeo;
Julian epoch;
};
private: private:
void Initialize(const double& theta2, const double& betao2, const double& betao, const double& eosq); void Initialize(const double& theta2, const double& betao2, const double& betao, const double& eosq);
void DeepSpaceInitialize(const double& eosq, const double& sinio, const double& cosio, const double& betao, void DeepSpaceInitialize(const double& eosq, const double& sinio, const double& cosio, const double& betao,