]> git.mxchange.org Git - flightgear.git/blobdiff - src/FDM/flight.hxx
b) FDM - ada.cxx, ada.hxx have been updated with the faux, daux and iaux arrays that...
[flightgear.git] / src / FDM / flight.hxx
index 306611fa4d7cfce08eabee8a4370b12e9aca58c3..35e9c2c9d1f1b10600aca407ffeae37b190b61cc 100644 (file)
 
 #include <list>
 #include <vector>
+#include <string>
 
+#include <simgear/constants.h>
 #include <simgear/timing/timestamp.hxx>
 
-FG_USING_STD(list);
-FG_USING_STD(vector);
+#include <Main/fgfs.hxx>
+
+SG_USING_STD(list);
+SG_USING_STD(vector);
+SG_USING_STD(string);
 
 
 typedef double FG_VECTOR_3[3];
@@ -108,12 +113,13 @@ private:
 
     // outputs
     double RPM;
-    double Manifold_Pressure;
+    double Manifold_Pressure;     //inches
     double MaxHP;
-    double Percentage_Power;
-    double EGT;
-    double CHT;
-    double prop_thrust;
+    double Percentage_Power;      //HP
+    double EGT;                   //deg F
+    double CHT;                   //deg F
+    double prop_thrust;           //lbs
+    double Fuel_Flow;             //Gals/hr
     
     /* others...
     double PercentN1,N1;  //GE,CFM
@@ -140,6 +146,7 @@ public:
     inline double get_EGT() const { return EGT; }
     inline double get_CHT() const { return CHT; }
     inline double get_prop_thrust() const { return prop_thrust; }
+    inline double get_Fuel_Flow() const { return Fuel_Flow; }
 
     inline void set_Throttle( double t ) { Throttle = t; }
     inline void set_Mixture( double m ) { Mixture = m; }
@@ -151,6 +158,7 @@ public:
     inline void set_EGT( double e ) { EGT = e; }
     inline void set_CHT( double c ) { CHT = c; }
     inline void set_prop_thrust( double t ) { prop_thrust = t; }
+    inline void set_Fuel_Flow( double f ) { Fuel_Flow = f; }
 
 };
 
@@ -158,10 +166,26 @@ typedef vector < FGEngInterface > engine_list;
 
 
 // This is based heavily on LaRCsim/ls_generic.h
-class FGInterface {
+class FGInterface : public FGSubsystem {
 
 private:
   
+    // periodic update management variable.  This is a scheme to run
+    // the fdm with a fixed delta-t.  We control how many iteration of
+    // the fdm to run with the fixed dt based on the elapsed time from
+    // the last update.  This allows us to maintain sync with the real
+    // time clock, even though each frame could take a random amount
+    // of time.  Since "dt" is unlikely to divide evenly into the
+    // elapse time, we keep track of the remainder and add it into the
+    // next elapsed time.  This yields a small amount of temporal
+    // jitter ( < dt ) but in practice seems to work well.
+
+    double delta_t;            // delta "t"
+    SGTimeStamp time_stamp;    // time stamp of last run
+    long elapsed;              // time elapsed since last run
+    long remainder;            // remainder time from last run
+    int multi_loop;            // number of iterations of "delta_t" to run
+
     // Pilot location rel to ref pt
     FG_VECTOR_3 d_pilot_rp_body_v;
 
@@ -248,14 +272,27 @@ private:
     double sin_longitude, cos_longitude;
     double sin_latitude, cos_latitude;
     double altitude_agl;
-    
+    double Tank1Fuel;             // Gals
+    double Tank2Fuel;             // Gals
+
+    double daux[16];           // auxilliary doubles
+    float  faux[16];           // auxilliary floats
+    int    iaux[16];           // auxilliary ints
+
     // Engine list
     engine_list engines;
 
-    SGTimeStamp valid_stamp;          // time this record is valid
-    SGTimeStamp next_stamp;           // time this record is valid
+    // SGTimeStamp valid_stamp;          // time this record is valid
+    // SGTimeStamp next_stamp;           // time this record is valid
+
+// protected:
+public:
+
+                               // deliberately not virtual so that
+                               // FGInterface constructor will call
+                               // the right version
+    void _setup();
 
-protected:
     void _busdump(void);
     void _updatePosition( double lat_geoc, double lon, double alt );
     void _updateWeather( void );
@@ -410,13 +447,23 @@ protected:
        cos_latitude = cos(parm);
     }
 
+    inline void _set_daux( int n, double value ) { daux[n] = value; }
+    inline void _set_faux( int n, float value ) { faux[n] = value; }
+    inline void _set_iaux( int n, int value ) { iaux[n] = value; }
+
 public:
   
-    FGInterface(void);
+    FGInterface();
+    FGInterface( double dt );
     virtual ~FGInterface();
 
-    virtual bool init( double dt );
+    virtual void init ();
+    virtual void bind ();
+    virtual void unbind ();
+    virtual void update ();
     virtual bool update( int multi_loop );
+    virtual bool ToggleDataLogging(bool state) { return false; }
+    virtual bool ToggleDataLogging(void) { return false; }
 
     // Define the various supported flight models (many not yet implemented)
     enum {
@@ -447,20 +494,71 @@ public:
        FG_EXTERNAL = 10
     };
 
+    // time and update management values
+    inline double get_delta_t() const { return delta_t; }
+    inline void set_delta_t( double dt ) { delta_t = dt; }
+    inline SGTimeStamp get_time_stamp() const { return time_stamp; }
+    inline void set_time_stamp( SGTimeStamp s ) { time_stamp = s; }
+    inline void stamp() { time_stamp.stamp(); }
+    inline long get_elapsed() const { return elapsed; }
+    inline void set_elapsed( long e ) { elapsed = e; }
+    inline long get_remainder() const { return remainder; }
+    inline void set_remainder( long r ) { remainder = r; }
+    inline int get_multi_loop() const { return multi_loop; }
+    inline void set_multi_loop( int ml ) { multi_loop = ml; }
+
     // Positions
     virtual void set_Latitude(double lat);       // geocentric
     virtual void set_Longitude(double lon);    
     virtual void set_Altitude(double alt);  // triggers re-calc of AGL altitude
     virtual void set_AltitudeAGL(double altagl); // and vice-versa
+    virtual void set_Latitude_deg (double lat) {
+      set_Latitude(lat * SGD_DEGREES_TO_RADIANS);
+    }
+    virtual void set_Longitude_deg (double lon) {
+      set_Longitude(lon * SGD_DEGREES_TO_RADIANS);
+    }
     
     // Speeds -- setting any of these will trigger a re-calc of the rest
     virtual void set_V_calibrated_kts(double vc);
     virtual void set_Mach_number(double mach);
     virtual void set_Velocities_Local( double north, double east, double down );
+    inline void set_V_north (double north) { 
+      set_Velocities_Local(north, v_local_v[1], v_local_v[2]);
+    }
+    inline void set_V_east (double east) { 
+      set_Velocities_Local(v_local_v[0], east, v_local_v[2]);
+    }
+    inline void set_V_down (double down) { 
+      set_Velocities_Local(v_local_v[0], v_local_v[1], down);
+    }
     virtual void set_Velocities_Wind_Body( double u, double v, double w);
+    virtual void set_uBody (double uBody) { 
+      set_Velocities_Wind_Body(uBody, v_wind_body_v[1], v_wind_body_v[2]);
+    }
+    virtual void set_vBody (double vBody) { 
+      set_Velocities_Wind_Body(v_wind_body_v[0], vBody, v_wind_body_v[2]);
+    }
+    virtual void set_wBody (double wBody) {
+      set_Velocities_Wind_Body(v_wind_body_v[0], v_wind_body_v[1], wBody);
+    }
     
     // Euler angles 
     virtual void set_Euler_Angles( double phi, double theta, double psi );
+    virtual void set_Phi (double phi) {
+      set_Euler_Angles(phi, get_Theta(), get_Psi());
+    }
+    virtual void set_Theta (double theta) {
+      set_Euler_Angles(get_Phi(), theta, get_Psi());
+    }
+    virtual void set_Psi (double psi) { 
+      set_Euler_Angles(get_Phi(), get_Theta(), psi);
+    }
+    virtual void set_Phi_deg (double phi) { set_Phi(phi * SGD_DEGREES_TO_RADIANS); }
+    virtual void set_Theta_deg (double theta) {
+      set_Theta(theta * SGD_DEGREES_TO_RADIANS); 
+    }
+    virtual void set_Psi_deg (double psi) { set_Psi(psi * SGD_DEGREES_TO_RADIANS); }
     
     // Flight Path
     virtual void set_Climb_Rate( double roc);
@@ -477,7 +575,22 @@ public:
     virtual void set_Velocities_Local_Airmass (double wnorth, 
                                               double weast, 
                                               double wdown );
-    
+
+    // Consumables
+    inline void set_Tank1Fuel( double f ) { Tank1Fuel = f; }
+    inline void set_Tank2Fuel( double f ) { Tank2Fuel = f; }
+
+    inline void reduce_Tank1Fuel( double f ) { 
+        Tank1Fuel -= f;
+        if(Tank1Fuel < 0)
+           Tank1Fuel = 0;
+    }
+    inline void reduce_Tank2Fuel( double f ) { 
+        Tank2Fuel -= f;
+        if(Tank2Fuel < 0)
+           Tank2Fuel = 0;
+    }  
+
     
     // ========== Mass properties and geometry values ==========
 
@@ -667,19 +780,25 @@ public:
     inline double get_V_north() const { return v_local_v[0]; }
     inline double get_V_east() const { return v_local_v[1]; }
     inline double get_V_down() const { return v_local_v[2]; }
-
-    // inline double * get_V_local_rel_ground_v() {
-    //     return v_local_rel_ground_v;
-    // }
-    // inline double get_V_north_rel_ground() const {
-    //     return v_local_rel_ground_v[0];
-    // }
-    // inline double get_V_east_rel_ground() const {
-    //     return v_local_rel_ground_v[1];
-    // }
-    // inline double get_V_down_rel_ground() const {
-    //    return v_local_rel_ground_v[2];
-    // }
+    inline double get_uBody () const { return v_wind_body_v[0]; }
+    inline double get_vBody () const { return v_wind_body_v[1]; }
+    inline double get_wBody () const { return v_wind_body_v[2]; }
+
+    // Please dont comment these out. fdm=ada uses these (see
+    // cockpit.cxx) --->
+    inline double * get_V_local_rel_ground_v() {
+        return v_local_rel_ground_v;
+    }
+    inline double get_V_north_rel_ground() const {
+        return v_local_rel_ground_v[0];
+    }
+    inline double get_V_east_rel_ground() const {
+        return v_local_rel_ground_v[1];
+    }
+    inline double get_V_down_rel_ground() const {
+        return v_local_rel_ground_v[2];
+    }
+    // <--- fdm=ada uses these (see cockpit.cxx)
 
     // inline double * get_V_local_airmass_v() { return v_local_airmass_v; }
     inline double get_V_north_airmass() const { return v_local_airmass_v[0]; }
@@ -801,12 +920,22 @@ public:
     inline double get_Latitude() const { return geodetic_position_v[0]; }
     inline double get_Longitude() const { return geodetic_position_v[1]; }
     inline double get_Altitude() const { return geodetic_position_v[2]; }
-    inline double get_Altitude_AGL(void) { return altitude_agl; }
+    inline double get_Altitude_AGL(void) const { return altitude_agl; }
+
+    inline double get_Latitude_deg () const {
+      return get_Latitude() * SGD_RADIANS_TO_DEGREES;
+    }
+    inline double get_Longitude_deg () const {
+      return get_Longitude() * SGD_RADIANS_TO_DEGREES;
+    }
 
     // inline double * get_Euler_angles_v() { return euler_angles_v; }
     inline double get_Phi() const { return euler_angles_v[0]; }
     inline double get_Theta() const { return euler_angles_v[1]; }
     inline double get_Psi() const { return euler_angles_v[2]; }
+    inline double get_Phi_deg () const { return get_Phi() * SGD_RADIANS_TO_DEGREES; }
+    inline double get_Theta_deg () const { return get_Theta() * SGD_RADIANS_TO_DEGREES; }
+    inline double get_Psi_deg () const { return get_Psi() * SGD_RADIANS_TO_DEGREES; }
 
 
     // ========== Miscellaneous quantities ==========
@@ -974,8 +1103,8 @@ public:
 
     inline double get_Climb_Rate() const { return climb_rate; }
 
-    inline SGTimeStamp get_time_stamp() const { return valid_stamp; }
-    inline void stamp_time() { valid_stamp = next_stamp; next_stamp.stamp(); }
+    // inline SGTimeStamp get_time_stamp() const { return valid_stamp; }
+    // inline void stamp_time() { valid_stamp = next_stamp; next_stamp.stamp(); }
 
     // Extrapolate FDM based on time_offset (in usec)
     void extrapolate( int time_offset );
@@ -1002,6 +1131,15 @@ public:
        return cos_latitude;
     }
 
+    // Auxilliary variables
+    inline double get_daux( int n ) const { return daux[n]; }
+    inline float  get_faux( int n ) const { return faux[n]; }
+    inline int    get_iaux( int n ) const { return iaux[n]; }
+
+    // Consumables
+    inline double get_Tank1Fuel() const { return Tank1Fuel; }
+    inline double get_Tank2Fuel() const { return Tank2Fuel; }
+
     // engines
     inline double get_num_engines() const {
        return engines.size();
@@ -1027,17 +1165,14 @@ extern FGInterface * cur_fdm_state;
 
 // General interface to the flight model routines
 
-// Initialize the flight model parameters
-int fgFDMInit(int model, FGInterface& f, double dt);
-
-// Run multiloop iterations of the flight model
-int fgFDMUpdate(int model, FGInterface& f, int multiloop, int jitter);
-
 // Set the altitude (force)
-void fgFDMForceAltitude(int model, double alt_meters);
+void fgFDMForceAltitude(const string &model, double alt_meters);
 
 // Set the local ground elevation
-void fgFDMSetGroundElevation(int model, double alt_meters);
+void fgFDMSetGroundElevation(const string &model, double alt_meters);
+
+// Toggle data logging on/off
+void fgToggleFDMdataLogging(void);
 
 
 #endif // _FLIGHT_HXX