Added a rate of climb calculation.

[flightgear.git] / FDM / flight.c

diff --git a/FDM/flight.c b/FDM/flight.c
index f0d5fa580e233189b261a407b7677d2cf281a020..d2bad6d42f3099ba5859c119c718ad11180e9fa5 100644 (file)
--- a/FDM/flight.c
+++ b/FDM/flight.c
@@ -23,20 +23,165 @@
  * (Log is kept at end of this file)
  **************************************************************************/
 
+#include <stdio.h>
 
-#include "flight.h"
+#include <Debug/fg_debug.h>
+#include <Flight/flight.h>
+#include <Flight/LaRCsim/ls_interface.h>
+#include <Include/fg_constants.h>
+#include <Math/fg_geodesy.h>
+
+
+fgFLIGHT cur_flight_params;
 
 
 /* Initialize the flight model parameters */
-int fgFlightModelInit(int model);
+int fgFlightModelInit(int model, fgFLIGHT *f, double dt) {
+    double save_alt = 0.0;
+    int result;
+
+    fgPrintf(FG_FLIGHT,FG_INFO,"Initializing flight model\n");
+
+    if ( model == FG_SLEW ) {
+       // fgSlewInit(dt);
+    } else if ( model == FG_LARCSIM ) {
+       /* lets try to avoid really screwing up the LaRCsim model */
+       if ( FG_Altitude < -9000 ) {
+           save_alt = FG_Altitude;
+           FG_Altitude = 0;
+       }
+
+       fgFlight_2_LaRCsim(f);  /* translate FG to LaRCsim structure */
+       fgLaRCsimInit(dt);
+       fgPrintf( FG_FLIGHT, FG_INFO, "FG pos = %.2f\n", FG_Latitude );
+       fgLaRCsim_2_Flight(f);  /* translate LaRCsim back to FG structure */
+
+       /* but lets restore our original bogus altitude when we are done */
+       if ( save_alt < -9000 ) {
+           FG_Altitude = save_alt;
+       }
+    } else {
+       fgPrintf( FG_FLIGHT, FG_WARN,
+                 "Unimplemented flight model == %d\n", model );
+    }
+
+    result = 1;
+
+    return(result);
+}
+
+
+/* Run multiloop iterations of the flight model */
+int fgFlightModelUpdate(int model, fgFLIGHT *f, int multiloop) {
+    double time_step, start_elev, end_elev;
+    int result;
+    // printf("Altitude = %.2f\n", FG_Altitude * 0.3048);
+
+    time_step = (1.0 / DEFAULT_MODEL_HZ) * multiloop;
+    start_elev = FG_Altitude;
+
+    if ( model == FG_SLEW ) {
+       // fgSlewUpdate(f, multiloop);
+    } else if ( model == FG_LARCSIM ) {
+       fgLaRCsimUpdate(f, multiloop);
+    } else {
+       fgPrintf( FG_FLIGHT, FG_WARN,
+                 "Unimplemented flight model == %d\n", model );
+    }
+
+    end_elev = FG_Altitude;
+
+    FG_Climb_Rate = (end_elev - start_elev) / time_step;  /* feet per second */
+
+    result = 1;
+
+    return(result);
+}
+
+
+/* Set the altitude (force) */
+int fgFlightModelSetAltitude(int model, fgFLIGHT *f, double alt_meters) {
+    double sea_level_radius_meters;
+    double lat_geoc;
+    // Set the FG variables first
+    fgGeodToGeoc( FG_Latitude, alt_meters, 
+                 &sea_level_radius_meters, &lat_geoc);
 
+    FG_Altitude = alt_meters * METER_TO_FEET;
+    FG_Radius_to_vehicle = FG_Altitude + 
+       (sea_level_radius_meters * METER_TO_FEET);
 
-/* Run an iteration of the flight model */
-int fgFlightModelUpdate(int model);
+    /* additional work needed for some flight models */
+    if ( model == FG_LARCSIM ) {
+       ls_ForceAltitude(FG_Altitude);
+    }
+
+}
 
 
 /* $Log$
-/* Revision 1.1  1997/05/29 02:35:04  curt
-/* Initial revision.
+/* Revision 1.18  1998/09/29 02:02:40  curt
+/* Added a rate of climb calculation.
 /*
+ * Revision 1.17  1998/08/24 20:09:07  curt
+ * .
+ *
+ * Revision 1.16  1998/08/22  14:49:55  curt
+ * Attempting to iron out seg faults and crashes.
+ * Did some shuffling to fix a initialization order problem between view
+ * position, scenery elevation.
+ *
+ * Revision 1.15  1998/07/30 23:44:36  curt
+ * Beginning to add support for multiple flight models.
+ *
+ * Revision 1.14  1998/07/12 03:08:27  curt
+ * Added fgFlightModelSetAltitude() to force the altitude to something
+ * other than the current altitude.  LaRCsim doesn't let you do this by just
+ * changing FG_Altitude.
+ *
+ * Revision 1.13  1998/04/25 22:06:28  curt
+ * Edited cvs log messages in source files ... bad bad bad!
+ *
+ * Revision 1.12  1998/04/21 16:59:33  curt
+ * Integrated autopilot.
+ * Prepairing for C++ integration.
+ *
+ * Revision 1.11  1998/04/18 04:14:04  curt
+ * Moved fg_debug.c to it's own library.
+ *
+ * Revision 1.10  1998/02/07 15:29:37  curt
+ * Incorporated HUD changes and struct/typedef changes from Charlie Hotchkiss
+ * <chotchkiss@namg.us.anritsu.com>
+ *
+ * Revision 1.9  1998/01/27 00:47:53  curt
+ * Incorporated Paul Bleisch's <pbleisch@acm.org> new debug message
+ * system and commandline/config file processing code.
+ *
+ * Revision 1.8  1998/01/19 19:27:03  curt
+ * Merged in make system changes from Bob Kuehne <rpk@sgi.com>
+ * This should simplify things tremendously.
+ *
+ * Revision 1.7  1998/01/19 18:40:23  curt
+ * Tons of little changes to clean up the code and to remove fatal errors
+ * when building with the c++ compiler.
+ *
+ * Revision 1.6  1998/01/19 18:35:43  curt
+ * Minor tweaks and fixes for cygwin32.
+ *
+ * Revision 1.5  1997/12/30 20:47:37  curt
+ * Integrated new event manager with subsystem initializations.
+ *
+ * Revision 1.4  1997/12/10 22:37:42  curt
+ * Prepended "fg" on the name of all global structures that didn't have it yet.
+ * i.e. "struct WEATHER {}" became "struct fgWEATHER {}"
+ *
+ * Revision 1.3  1997/08/27 03:30:04  curt
+ * Changed naming scheme of basic shared structures.
+ *
+ * Revision 1.2  1997/05/29 22:39:57  curt
+ * Working on incorporating the LaRCsim flight model.
+ *
+ * Revision 1.1  1997/05/29 02:35:04  curt
+ * Initial revision.
+ *
  */