1 // flight.c -- a general interface to the various flight models
3 // Written by Curtis Olson, started May 1997.
5 // Copyright (C) 1997 Curtis L. Olson - curt@infoplane.com
7 // This program is free software; you can redistribute it and/or
8 // modify it under the terms of the GNU General Public License as
9 // published by the Free Software Foundation; either version 2 of the
10 // License, or (at your option) any later version.
12 // This program is distributed in the hope that it will be useful, but
13 // WITHOUT ANY WARRANTY; without even the implied warranty of
14 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 // General Public License for more details.
17 // You should have received a copy of the GNU General Public License
18 // along with this program; if not, write to the Free Software
19 // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 // (Log is kept at end of this file)
28 #include "LaRCsim.hxx"
30 #include <Debug/logstream.hxx>
31 #include <Flight/LaRCsim/ls_interface.h>
32 #include <Include/fg_constants.h>
33 #include <Math/fg_geodesy.hxx>
36 fgFLIGHT cur_flight_params;
39 /* Initialize the flight model parameters */
40 int fgFlightModelInit(int model, fgFLIGHT& f, double dt) {
41 double save_alt = 0.0;
44 FG_LOG( FG_FLIGHT ,FG_INFO, "Initializing flight model" );
46 if ( model == FG_SLEW ) {
48 } else if ( model == FG_LARCSIM ) {
49 /* lets try to avoid really screwing up the LaRCsim model */
50 if ( f.get_Altitude() < -9000.0 ) {
51 save_alt = f.get_Altitude();
52 f.set_Altitude( 0.0 );
55 fgFlight_2_LaRCsim(f); /* translate FG to LaRCsim structure */
57 FG_LOG( FG_FLIGHT, FG_INFO, "FG pos = " << f.get_Latitude() );
58 fgLaRCsim_2_Flight(f); /* translate LaRCsim back to FG structure */
60 /* but lets restore our original bogus altitude when we are done */
61 if ( save_alt < -9000.0 ) {
62 f.set_Altitude( save_alt );
65 FG_LOG( FG_FLIGHT, FG_WARN,
66 "Unimplemented flight model == " << model );
75 /* Run multiloop iterations of the flight model */
76 int fgFlightModelUpdate(int model, fgFLIGHT& f, int multiloop) {
77 double time_step, start_elev, end_elev;
79 // printf("Altitude = %.2f\n", FG_Altitude * 0.3048);
81 time_step = (1.0 / DEFAULT_MODEL_HZ) * multiloop;
82 start_elev = f.get_Altitude();
84 if ( model == FG_SLEW ) {
85 // fgSlewUpdate(f, multiloop);
86 } else if ( model == FG_LARCSIM ) {
87 fgLaRCsimUpdate(f, multiloop);
89 FG_LOG( FG_FLIGHT, FG_WARN,
90 "Unimplemented flight model == " << model );
93 end_elev = f.get_Altitude();
96 f.set_Climb_Rate( (end_elev - start_elev) / time_step );
104 /* Set the altitude (force) */
105 void fgFlightModelSetAltitude(int model, fgFLIGHT& f, double alt_meters) {
106 double sea_level_radius_meters;
108 // Set the FG variables first
109 fgGeodToGeoc( f.get_Latitude(), alt_meters,
110 &sea_level_radius_meters, &lat_geoc);
112 f.set_Altitude( alt_meters * METER_TO_FEET );
113 f.set_Radius_to_vehicle( f.get_Altitude() +
114 (sea_level_radius_meters * METER_TO_FEET) );
116 /* additional work needed for some flight models */
117 if ( model == FG_LARCSIM ) {
118 ls_ForceAltitude( f.get_Altitude() );
125 // Revision 1.4 1998/12/03 01:16:40 curt
126 // Converted fgFLIGHT to a class.
128 // Revision 1.3 1998/11/06 21:18:03 curt
129 // Converted to new logstream debugging facility. This allows release
130 // builds with no messages at all (and no performance impact) by using
131 // the -DFG_NDEBUGNDEBUG flag.
133 // Revision 1.2 1998/10/16 23:27:40 curt
136 // Revision 1.1 1998/10/16 20:16:41 curt
137 // Renamed flight.[ch] to flight.[ch]xx
139 // Revision 1.19 1998/09/29 14:57:38 curt
140 // c++-ified comments.
142 // Revision 1.18 1998/09/29 02:02:40 curt
143 // Added a rate of climb calculation.
145 // Revision 1.17 1998/08/24 20:09:07 curt
148 // Revision 1.16 1998/08/22 14:49:55 curt
149 // Attempting to iron out seg faults and crashes.
150 // Did some shuffling to fix a initialization order problem between view
151 // position, scenery elevation.
153 // Revision 1.15 1998/07/30 23:44:36 curt
154 // Beginning to add support for multiple flight models.
156 // Revision 1.14 1998/07/12 03:08:27 curt
157 // Added fgFlightModelSetAltitude() to force the altitude to something
158 // other than the current altitude. LaRCsim doesn't let you do this by just
159 // changing FG_Altitude.
161 // Revision 1.13 1998/04/25 22:06:28 curt
162 // Edited cvs log messages in source files ... bad bad bad!
164 // Revision 1.12 1998/04/21 16:59:33 curt
165 // Integrated autopilot.
166 // Prepairing for C++ integration.
168 // Revision 1.11 1998/04/18 04:14:04 curt
169 // Moved fg_debug.c to it's own library.
171 // Revision 1.10 1998/02/07 15:29:37 curt
172 // Incorporated HUD changes and struct/typedef changes from Charlie Hotchkiss
173 // <chotchkiss@namg.us.anritsu.com>
175 // Revision 1.9 1998/01/27 00:47:53 curt
176 // Incorporated Paul Bleisch's <pbleisch@acm.org> new debug message
177 // system and commandline/config file processing code.
179 // Revision 1.8 1998/01/19 19:27:03 curt
180 // Merged in make system changes from Bob Kuehne <rpk@sgi.com>
181 // This should simplify things tremendously.
183 // Revision 1.7 1998/01/19 18:40:23 curt
184 // Tons of little changes to clean up the code and to remove fatal errors
185 // when building with the c++ compiler.
187 // Revision 1.6 1998/01/19 18:35:43 curt
188 // Minor tweaks and fixes for cygwin32.
190 // Revision 1.5 1997/12/30 20:47:37 curt
191 // Integrated new event manager with subsystem initializations.
193 // Revision 1.4 1997/12/10 22:37:42 curt
194 // Prepended "fg" on the name of all global structures that didn't have it yet.
195 // i.e. "struct WEATHER {}" became "struct fgWEATHER {}"
197 // Revision 1.3 1997/08/27 03:30:04 curt
198 // Changed naming scheme of basic shared structures.
200 // Revision 1.2 1997/05/29 22:39:57 curt
201 // Working on incorporating the LaRCsim flight model.
203 // Revision 1.1 1997/05/29 02:35:04 curt