-/**************************************************************************
- * flight.c -- a general interface to the various flight models
- *
- * Written by Curtis Olson, started May 1997.
- *
- * Copyright (C) 1997 Curtis L. Olson - curt@infoplane.com
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; either version 2 of the
- * License, or (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful, but
- * WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
- *
- * $Id$
- * (Log is kept at end of this file)
- **************************************************************************/
+// flight.c -- a general interface to the various flight models
+//
+// Written by Curtis Olson, started May 1997.
+//
+// Copyright (C) 1997 Curtis L. Olson - curt@infoplane.com
+//
+// This program is free software; you can redistribute it and/or
+// modify it under the terms of the GNU General Public License as
+// published by the Free Software Foundation; either version 2 of the
+// License, or (at your option) any later version.
+//
+// This program is distributed in the hope that it will be useful, but
+// WITHOUT ANY WARRANTY; without even the implied warranty of
+// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+// General Public License for more details.
+//
+// You should have received a copy of the GNU General Public License
+// along with this program; if not, write to the Free Software
+// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+//
+// $Id$
+// (Log is kept at end of this file)
+
#include <stdio.h>
+
+#include <Debug/fg_debug.h>
#include <Flight/flight.h>
#include <Flight/LaRCsim/ls_interface.h>
-#include <Main/fg_debug.h>
+#include <Include/fg_constants.h>
+#include <Math/fg_geodesy.h>
fgFLIGHT cur_flight_params;
/* Initialize the flight model parameters */
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_LARCSIM ) {
+ 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);
+ 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);
+ fgPrintf( FG_FLIGHT, FG_WARN,
+ "Unimplemented flight model == %d\n", model );
}
result = 1;
/* 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);
- if ( model == FG_LARCSIM ) {
- fgFlight_2_LaRCsim(f); /* translate FG to LaRCsim structure */
- fgLaRCsimUpdate(multiloop);
- fgLaRCsim_2_Flight(f); /* translate LaRCsim back to FG structure */
+ 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);
+ 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);
}
-/* $Log$
-/* 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 <bleisch@chromatic.com> 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.
- *
- */
+/* 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);
+
+ /* additional work needed for some flight models */
+ if ( model == FG_LARCSIM ) {
+ ls_ForceAltitude(FG_Altitude);
+ }
+
+}
+
+
+// $Log$
+// Revision 1.19 1998/09/29 14:57:38 curt
+// c++-ified comments.
+//
+// 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.
+//