1 /**************************************************************************
2 * flight.c -- a general interface to the various flight models
4 * Written by Curtis Olson, started May 1997.
6 * Copyright (C) 1997 Curtis L. Olson - curt@infoplane.com
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of the
11 * License, or (at your option) any later version.
13 * This program is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 * (Log is kept at end of this file)
24 **************************************************************************/
28 #include <Debug/fg_debug.h>
29 #include <Flight/flight.h>
30 #include <Flight/LaRCsim/ls_interface.h>
31 #include <Include/fg_constants.h>
32 #include <Math/fg_geodesy.h>
35 fgFLIGHT cur_flight_params;
38 /* Initialize the flight model parameters */
39 int fgFlightModelInit(int model, fgFLIGHT *f, double dt) {
40 double save_alt = 0.0;
43 fgPrintf(FG_FLIGHT,FG_INFO,"Initializing flight model\n");
45 if ( model == FG_SLEW ) {
47 } else if ( model == FG_LARCSIM ) {
48 /* lets try to avoid really screwing up the LaRCsim model */
49 if ( FG_Altitude < -9000 ) {
50 save_alt = FG_Altitude;
54 fgFlight_2_LaRCsim(f); /* translate FG to LaRCsim structure */
56 fgPrintf( FG_FLIGHT, FG_INFO, "FG pos = %.2f\n", FG_Latitude );
57 fgLaRCsim_2_Flight(f); /* translate LaRCsim back to FG structure */
59 /* but lets restore our original bogus altitude when we are done */
60 if ( save_alt < -9000 ) {
61 FG_Altitude = save_alt;
64 fgPrintf( FG_FLIGHT, FG_WARN,
65 "Unimplemented flight model == %d\n", model );
74 /* Run multiloop iterations of the flight model */
75 int fgFlightModelUpdate(int model, fgFLIGHT *f, int multiloop) {
76 double time_step, start_elev, end_elev;
78 // printf("Altitude = %.2f\n", FG_Altitude * 0.3048);
80 time_step = (1.0 / DEFAULT_MODEL_HZ) * multiloop;
81 start_elev = FG_Altitude;
83 if ( model == FG_SLEW ) {
84 // fgSlewUpdate(f, multiloop);
85 } else if ( model == FG_LARCSIM ) {
86 fgLaRCsimUpdate(f, multiloop);
88 fgPrintf( FG_FLIGHT, FG_WARN,
89 "Unimplemented flight model == %d\n", model );
92 end_elev = FG_Altitude;
94 FG_Climb_Rate = (end_elev - start_elev) / time_step; /* feet per second */
102 /* Set the altitude (force) */
103 int fgFlightModelSetAltitude(int model, fgFLIGHT *f, double alt_meters) {
104 double sea_level_radius_meters;
106 // Set the FG variables first
107 fgGeodToGeoc( FG_Latitude, alt_meters,
108 &sea_level_radius_meters, &lat_geoc);
110 FG_Altitude = alt_meters * METER_TO_FEET;
111 FG_Radius_to_vehicle = FG_Altitude +
112 (sea_level_radius_meters * METER_TO_FEET);
114 /* additional work needed for some flight models */
115 if ( model == FG_LARCSIM ) {
116 ls_ForceAltitude(FG_Altitude);
123 /* Revision 1.18 1998/09/29 02:02:40 curt
124 /* Added a rate of climb calculation.
126 * Revision 1.17 1998/08/24 20:09:07 curt
129 * Revision 1.16 1998/08/22 14:49:55 curt
130 * Attempting to iron out seg faults and crashes.
131 * Did some shuffling to fix a initialization order problem between view
132 * position, scenery elevation.
134 * Revision 1.15 1998/07/30 23:44:36 curt
135 * Beginning to add support for multiple flight models.
137 * Revision 1.14 1998/07/12 03:08:27 curt
138 * Added fgFlightModelSetAltitude() to force the altitude to something
139 * other than the current altitude. LaRCsim doesn't let you do this by just
140 * changing FG_Altitude.
142 * Revision 1.13 1998/04/25 22:06:28 curt
143 * Edited cvs log messages in source files ... bad bad bad!
145 * Revision 1.12 1998/04/21 16:59:33 curt
146 * Integrated autopilot.
147 * Prepairing for C++ integration.
149 * Revision 1.11 1998/04/18 04:14:04 curt
150 * Moved fg_debug.c to it's own library.
152 * Revision 1.10 1998/02/07 15:29:37 curt
153 * Incorporated HUD changes and struct/typedef changes from Charlie Hotchkiss
154 * <chotchkiss@namg.us.anritsu.com>
156 * Revision 1.9 1998/01/27 00:47:53 curt
157 * Incorporated Paul Bleisch's <pbleisch@acm.org> new debug message
158 * system and commandline/config file processing code.
160 * Revision 1.8 1998/01/19 19:27:03 curt
161 * Merged in make system changes from Bob Kuehne <rpk@sgi.com>
162 * This should simplify things tremendously.
164 * Revision 1.7 1998/01/19 18:40:23 curt
165 * Tons of little changes to clean up the code and to remove fatal errors
166 * when building with the c++ compiler.
168 * Revision 1.6 1998/01/19 18:35:43 curt
169 * Minor tweaks and fixes for cygwin32.
171 * Revision 1.5 1997/12/30 20:47:37 curt
172 * Integrated new event manager with subsystem initializations.
174 * Revision 1.4 1997/12/10 22:37:42 curt
175 * Prepended "fg" on the name of all global structures that didn't have it yet.
176 * i.e. "struct WEATHER {}" became "struct fgWEATHER {}"
178 * Revision 1.3 1997/08/27 03:30:04 curt
179 * Changed naming scheme of basic shared structures.
181 * Revision 1.2 1997/05/29 22:39:57 curt
182 * Working on incorporating the LaRCsim flight model.
184 * Revision 1.1 1997/05/29 02:35:04 curt