-// Extrapolate fdm based on jitter time (in milliseconds)
-static FGState extrapolate_fdm( FGState &base, int jitter ) {
- FGState result;
-
- double dt = jitter / 1000000.0;
- // cout << "dt = " << dt << endl;
-
- // start by making a straight up copy
- result = base;
-
- double lon = base.get_Longitude() + base.get_Longitude_dot() * dt;
- double lon_geoc = base.get_Lon_geocentric() + base.get_Longitude_dot() * dt;
-
- double lat = base.get_Latitude() + base.get_Latitude_dot() * dt;
- double lat_geoc = base.get_Lat_geocentric() + base.get_Latitude_dot() * dt;
-
- /*
- cout << "( " << base.get_Longitude() << ", " <<
- base.get_Latitude() << " )" << endl;
- cout << "( " << lon << ", " << lat << " )" << endl;
- cout << "( " << base.get_Longitude_dot() * dt << ", " <<
- base.get_Latitude_dot() * dt << ", " <<
- base.get_Radius_dot() * dt << " )" << endl;
- */
-
- double alt = base.get_Altitude() + base.get_Radius_dot() * dt;
- double radius = base.get_Radius_to_vehicle() + base.get_Radius_dot() * dt;
-
- // result.set_Longitude( lon );
- // result.set_Latitude( lat );
- // result.set_Altitude( alt );
- // result.set_Geocentric_Position( lon_geoc, lat_geoc, radius );
-
- return result;
-}
-
-