Edited FindPositionSDP4() to start testing SDP4

feature/19
Daniel Warner 2011-03-30 13:59:34 +01:00
parent eebc89f6a3
commit 43f6aca6f8
1 changed files with 11 additions and 13 deletions

View File

@ -265,8 +265,8 @@ void SGDP4::FindPositionSDP4(double tsince) {
/* /*
* update for secular gravity and atmospheric drag * update for secular gravity and atmospheric drag
*/ */
const double xmdf = MeanAnomoly() + i_xmdot_ * tsince; double xmdf = MeanAnomoly() + i_xmdot_ * tsince;
const double omgadf = ArgumentPerigee() + i_omgdot_ * tsince; double omgadf = ArgumentPerigee() + i_omgdot_ * tsince;
const double xnoddf = AscendingNode() + i_xnodot_ * tsince; const double xnoddf = AscendingNode() + i_xnodot_ * tsince;
const double tsq = tsince * tsince; const double tsq = tsince * tsince;
@ -278,11 +278,10 @@ void SGDP4::FindPositionSDP4(double tsince) {
double em = Eccentricity(); double em = Eccentricity();
double xinc = Inclination(); double xinc = Inclination();
double xn = RecoveredMeanMotion(); double xn = RecoveredMeanMotion();
#if 0
CALL DPSEC(XMDF, OMGADF, XNODE, EM, XINC, XN, TSINCE) //CALL DPSEC(XMDF, OMGADF, XNODE, EM, XINC, XN, TSINCE)
ENTRY DPSEC(XLL, OMGASM, XNODES, EM, XINC, XN, T) //ENTRY DPSEC(XLL, OMGASM, XNODES, EM, XINC, XN, T)
DeepSecular(tsince, xll, omgasm, DeepSecular(tsince, xmdf, omgadf, xnode, em, xinc, xn);
xnodes, em, xinc, xn);
a = pow(constants_.XKE / xn, constants_.TWOTHRD) * pow(tempa, 2.0); a = pow(constants_.XKE / xn, constants_.TWOTHRD) * pow(tempa, 2.0);
xn = constants_.XKE / pow(a, 1.5); xn = constants_.XKE / pow(a, 1.5);
@ -290,13 +289,12 @@ void SGDP4::FindPositionSDP4(double tsince) {
double xmam = xmdf + RecoveredMeanMotion() * templ; double xmam = xmdf + RecoveredMeanMotion() * templ;
CALL DPPER(E, XINC, OMGADF, XNODE, XMAM) //CALL DPPER(E, XINC, OMGADF, XNODE, XMAM)
ENTRY DPPER(EM, XINC, OMGASM, XNODES, XLL) //ENTRY DPPER(EM, XINC, OMGASM, XNODES, XLL)
DeepPeriodics(tsince, final_eccentricity, DeepPeriodics(tsince, e, xinc, omgadf, xnode, xmam);
final_inclination, final_arg_perigee, final_ascending_node, xmam);
xl = xmam + final_arg_perigee + xnode; xl = xmam + omgadf + xnode;
#endif xincl = xinc;
/* /*
* re-compute the perturbed values * re-compute the perturbed values