X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FFDM%2Fflight.cxx;h=2694fa7f44f3b31ee44f9ac69ac990db788710b7;hb=0cabedaa4f8ce11bdab4d182937110d111d2590c;hp=9bc133c08dba5b344b6832d9920dbb18af3ff8c2;hpb=93c69c4bc348b899eebc278e978ad518cdb4d780;p=flightgear.git diff --git a/src/FDM/flight.cxx b/src/FDM/flight.cxx index 9bc133c08..2694fa7f4 100644 --- a/src/FDM/flight.cxx +++ b/src/FDM/flight.cxx @@ -35,11 +35,7 @@ #include
#include
-#include "External.hxx" #include "flight.hxx" -#include "JSBSim.hxx" -#include "LaRCsim.hxx" -#include "Balloon.h" // base_fdm_state is the internal state that is updated in integer @@ -61,8 +57,9 @@ FGInterface::FGInterface() { FGInterface::FGInterface( double dt ) { _setup(); - delta_t = dt; - remainder = elapsed = multi_loop = 0; +// delta_t = dt; +// remainder = elapsed = multi_loop = 0; + remainder = 0; } // Destructor @@ -71,6 +68,21 @@ FGInterface::~FGInterface() { } +int +FGInterface::_calc_multiloop (double dt) +{ + int hz = fgGetInt("/sim/model-hz"); + int speedup = fgGetInt("/sim/speed-up"); + + dt += remainder; + remainder = 0; + double ml = dt * hz; + int multiloop = int(floor(ml)); + remainder = (ml - multiloop) / hz; + return (multiloop * speedup); +} + + /** * Set default values for the state of the FDM. * @@ -147,6 +159,7 @@ FGInterface::_setup () sin_latitude=cos_latitude=0; sin_longitude=cos_longitude=0; altitude_agl=0; + _acmodel = 0; } void @@ -167,8 +180,14 @@ FGInterface::common_init () set_inited( true ); - stamp(); - set_remainder( 0 ); +// stamp(); +// set_remainder( 0 ); + + // linking in FGAircraft instance... + // FIXME: when using multiple instances, then there will be more than + // one model so get_aircraft_model will have to be indexed to the correct + // model. + _acmodel = globals->get_aircraft_model(); // Set initial position SG_LOG( SG_FLIGHT, SG_INFO, "...initializing position..." ); @@ -176,8 +195,10 @@ FGInterface::common_init () * SGD_DEGREES_TO_RADIANS ); set_Latitude( fgGetDouble("/position/latitude-deg") * SGD_DEGREES_TO_RADIANS ); - double ground_elev_m = scenery.get_cur_elev(); + double ground_elev_m = globals->get_scenery()->get_cur_elev(); double ground_elev_ft = ground_elev_m * SG_METER_TO_FEET; + _acmodel->get3DModel()->getFGLocation()->set_cur_elev_m( ground_elev_m ); + _set_Runway_altitude ( ground_elev_ft ); if ( fgGetBool("/sim/startup/onground") || fgGetDouble("/position/altitude-ft") < ground_elev_ft ) { fgSetDouble("/position/altitude-ft", ground_elev_ft); @@ -258,14 +279,14 @@ FGInterface::bind () bound = true; // Time management (read-only) - fgTie("/fdm/time/delta_t", this, - &FGInterface::get_delta_t); // read-only - fgTie("/fdm/time/elapsed", this, - &FGInterface::get_elapsed); // read-only - fgTie("/fdm/time/remainder", this, - &FGInterface::get_remainder); // read-only - fgTie("/fdm/time/multi_loop", this, - &FGInterface::get_multi_loop); // read-only +// fgTie("/fdm/time/delta_t", this, +// &FGInterface::get_delta_t); // read-only +// fgTie("/fdm/time/elapsed", this, +// &FGInterface::get_elapsed); // read-only +// fgTie("/fdm/time/remainder", this, +// &FGInterface::get_remainder); // read-only +// fgTie("/fdm/time/multi_loop", this, +// &FGInterface::get_multi_loop); // read-only // Aircraft position fgTie("/position/latitude-deg", this, @@ -351,7 +372,11 @@ FGInterface::bind () // Climb and slip (read-only) fgTie("/velocities/vertical-speed-fps", this, - &FGInterface::get_Climb_Rate); // read-only + &FGInterface::get_Climb_Rate, + &FGInterface::set_Climb_Rate ); + fgTie("/velocities/glideslope", this, + &FGInterface::get_Gamma_vert_rad, + &FGInterface::set_Gamma_vert_rad ); fgTie("/velocities/side-slip-rad", this, &FGInterface::get_Beta); // read-only fgTie("/velocities/side-slip-deg", this, @@ -360,8 +385,6 @@ FGInterface::bind () &FGInterface::get_Alpha_deg); // read-only fgTie("/accelerations/nlf", this, &FGInterface::get_Nlf); // read-only - - } @@ -395,6 +418,7 @@ FGInterface::unbind () fgUntie("/velocities/vBody-fps"); fgUntie("/velocities/wBody-fps"); fgUntie("/velocities/vertical-speed-fps"); + fgUntie("/velocities/glideslope"); fgUntie("/velocities/side-slip-rad"); fgUntie("/velocities/side-slip-deg"); fgUntie("/velocities/alpha-deg"); @@ -406,9 +430,9 @@ FGInterface::unbind () * Update the state of the FDM (i.e. run the equations of motion). */ void -FGInterface::update (int dt) +FGInterface::update (double dt) { - cout << "dummy update() ... SHOULDN'T BE CALLED!" << endl; + SG_LOG(SG_FLIGHT, SG_ALERT, "dummy update() ... SHOULDN'T BE CALLED!"); } @@ -433,7 +457,7 @@ void FGInterface::_updateGeodeticPosition( double lat, double lon, double alt ) _set_Geodetic_Position( lat, lon, alt ); _set_Sea_level_radius( sl_radius * SG_METER_TO_FEET ); - _set_Runway_altitude( scenery.get_cur_elev() * SG_METER_TO_FEET ); + _set_Runway_altitude( getACModel()->get3DModel()->getFGLocation()->get_cur_elev_m() * SG_METER_TO_FEET ); _set_sin_lat_geocentric( lat_geoc ); _set_cos_lat_geocentric( lat_geoc ); @@ -489,7 +513,7 @@ void FGInterface::_updateGeocentricPosition( double lat_geoc, double lon, _set_Geodetic_Position( lat_geod, lon, alt ); _set_Sea_level_radius( sl_radius2 * SG_METER_TO_FEET ); - _set_Runway_altitude( scenery.get_cur_elev() * SG_METER_TO_FEET ); + _set_Runway_altitude( getACModel()->get3DModel()->getFGLocation()->get_cur_elev_m() * SG_METER_TO_FEET ); _set_sin_lat_geocentric( lat_geoc ); _set_cos_lat_geocentric( lat_geoc ); @@ -526,7 +550,7 @@ void FGInterface::extrapolate( int time_offset ) { // -dw- metrowerks complains about ambiguous access, not critical // to keep this ;) #ifndef __MWERKS__ - cout << "extrapolating FDM by dt = " << dt << endl; + SG_LOG(SG_FLIGHT, SG_INFO, "extrapolating FDM by dt = " << dt); #endif double lat = geodetic_position_v[0] + geocentric_rates_v[0] * dt;