Changeset 2556 in ntrip for trunk/BNC/RTCM3
- Timestamp:
- Aug 10, 2010, 9:29:33 PM (15 years ago)
- Location:
- trunk/BNC/RTCM3
- Files:
-
- 2 edited
Legend:
- Unmodified
- Added
- Removed
-
TabularUnified trunk/BNC/RTCM3/ephemeris.cpp ¶
r2429 r2556 157 157 // Derivative of the state vector using a simple force model (static) 158 158 //////////////////////////////////////////////////////////////////////////// 159 ColumnVector t_ephGlo::glo_deriv(double /* tt */, const ColumnVector& xv) { 159 ColumnVector t_ephGlo::glo_deriv(double /* tt */, const ColumnVector& xv, 160 double* acc) { 160 161 161 162 // State vector components … … 169 170 static const double AE = 6378136.0; 170 171 static const double OMEGA = 7292115.e-11; 171 static const double C20 = -1082.6 3e-6;172 static const double C20 = -1082.625e-6; 172 173 173 174 double rho = rr.norm_Frobenius(); … … 184 185 va(2) = vv(2); 185 186 va(3) = vv(3); 186 va(4) = (t1 + t2*(1.0-5.0*z2/(rho*rho)) + t3) * rr(1) + t4*vv(2); 187 va(5) = (t1 + t2*(1.0-5.0*z2/(rho*rho)) + t3) * rr(2) - t4*vv(1); 188 va(6) = (t1 + t2*(3.0-5.0*z2/(rho*rho)) ) * rr(3); 187 va(4) = (t1 + t2*(1.0-5.0*z2/(rho*rho)) + t3) * rr(1) + t4*vv(2) + acc[0]; 188 va(5) = (t1 + t2*(1.0-5.0*z2/(rho*rho)) + t3) * rr(2) - t4*vv(1) + acc[1]; 189 va(6) = (t1 + t2*(3.0-5.0*z2/(rho*rho)) ) * rr(3) + acc[2]; 189 190 190 191 return va; … … 210 211 double step = dtPos / nSteps; 211 212 213 double acc[3]; 214 acc[0] = _x_acceleration; 215 acc[1] = _x_acceleration; 216 acc[2] = _x_acceleration; 212 217 for (int ii = 1; ii <= nSteps; ii++) { 213 _xv = rungeKutta4(_tt, _xv, step, glo_deriv); 218 _xv = rungeKutta4(_tt, _xv, step, acc, glo_deriv); 214 219 _tt += step; 215 220 } -
TabularUnified trunk/BNC/RTCM3/ephemeris.h ¶
r2492 r2556 104 104 105 105 private: 106 static ColumnVector glo_deriv(double /* tt */, const ColumnVector& xv); 106 static ColumnVector glo_deriv(double /* tt */, const ColumnVector& xv, 107 double* acc); 107 108 108 109 mutable double _tt; // time in seconds of GPSweek
Note:
See TracChangeset
for help on using the changeset viewer.