FDM/flight.c

   1 /**************************************************************************
   2  * flight.c -- a general interface to the various flight models
   3  *
   4  * Written by Curtis Olson, started May 1997.
   5  *
   6  * Copyright (C) 1997  Curtis L. Olson  - curt@infoplane.com
   7  *
   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.
  12  *
  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.
  17  *
  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.
  21  *
  22  * $Id$
  23  * (Log is kept at end of this file)
  24  **************************************************************************/
  25
  26 #include <stdio.h>
  27
  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>
  33
  34
  35 fgFLIGHT cur_flight_params;
  36
  37
  38 /* Initialize the flight model parameters */
  39 int fgFlightModelInit(int model, fgFLIGHT *f, double dt) {
  40     double save_alt = 0.0;
  41     int result;
  42
  43     fgPrintf(FG_FLIGHT,FG_INFO,"Initializing flight model\n");
  44
  45     if ( model == FG_SLEW ) {
  46         // fgSlewInit(dt);
  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;
  51             FG_Altitude = 0;
  52         }
  53
  54         fgFlight_2_LaRCsim(f);  /* translate FG to LaRCsim structure */
  55         fgLaRCsimInit(dt);
  56         fgPrintf( FG_FLIGHT, FG_INFO, "FG pos = %.2f\n", FG_Latitude );
  57         fgLaRCsim_2_Flight(f);  /* translate LaRCsim back to FG structure */
  58
  59         /* but lets restore our original bogus altitude when we are done */
  60         if ( save_alt < -9000 ) {
  61             FG_Altitude = save_alt;
  62         }
  63     } else {
  64         fgPrintf( FG_FLIGHT, FG_WARN,
  65                   "Unimplemented flight model == %d\n", model );
  66     }
  67
  68     result = 1;
  69
  70     return(result);
  71 }
  72
  73
  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;
  77     int result;
  78     // printf("Altitude = %.2f\n", FG_Altitude * 0.3048);
  79
  80     time_step = (1.0 / DEFAULT_MODEL_HZ) * multiloop;
  81     start_elev = FG_Altitude;
  82
  83     if ( model == FG_SLEW ) {
  84         // fgSlewUpdate(f, multiloop);
  85     } else if ( model == FG_LARCSIM ) {
  86         fgLaRCsimUpdate(f, multiloop);
  87     } else {
  88         fgPrintf( FG_FLIGHT, FG_WARN,
  89                   "Unimplemented flight model == %d\n", model );
  90     }
  91
  92     end_elev = FG_Altitude;
  93
  94     FG_Climb_Rate = (end_elev - start_elev) / time_step;  /* feet per second */
  95
  96     result = 1;
  97
  98     return(result);
  99 }
 100
 101
 102 /* Set the altitude (force) */
 103 int fgFlightModelSetAltitude(int model, fgFLIGHT *f, double alt_meters) {
 104     double sea_level_radius_meters;
 105     double lat_geoc;
 106     // Set the FG variables first
 107     fgGeodToGeoc( FG_Latitude, alt_meters,
 108                   &sea_level_radius_meters, &lat_geoc);
 109
 110     FG_Altitude = alt_meters * METER_TO_FEET;
 111     FG_Radius_to_vehicle = FG_Altitude +
 112         (sea_level_radius_meters * METER_TO_FEET);
 113
 114     /* additional work needed for some flight models */
 115     if ( model == FG_LARCSIM ) {
 116         ls_ForceAltitude(FG_Altitude);
 117     }
 118
 119 }
 120
 121
 122 /* $Log$
 123 /* Revision 1.18  1998/09/29 02:02:40  curt
 124 /* Added a rate of climb calculation.
 125 /*
 126  * Revision 1.17  1998/08/24 20:09:07  curt
 127  * .
 128  *
 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.
 133  *
 134  * Revision 1.15  1998/07/30 23:44:36  curt
 135  * Beginning to add support for multiple flight models.
 136  *
 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.
 141  *
 142  * Revision 1.13  1998/04/25 22:06:28  curt
 143  * Edited cvs log messages in source files ... bad bad bad!
 144  *
 145  * Revision 1.12  1998/04/21 16:59:33  curt
 146  * Integrated autopilot.
 147  * Prepairing for C++ integration.
 148  *
 149  * Revision 1.11  1998/04/18 04:14:04  curt
 150  * Moved fg_debug.c to it's own library.
 151  *
 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>
 155  *
 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.
 159  *
 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.
 163  *
 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.
 167  *
 168  * Revision 1.6  1998/01/19 18:35:43  curt
 169  * Minor tweaks and fixes for cygwin32.
 170  *
 171  * Revision 1.5  1997/12/30 20:47:37  curt
 172  * Integrated new event manager with subsystem initializations.
 173  *
 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 {}"
 177  *
 178  * Revision 1.3  1997/08/27 03:30:04  curt
 179  * Changed naming scheme of basic shared structures.
 180  *
 181  * Revision 1.2  1997/05/29 22:39:57  curt
 182  * Working on incorporating the LaRCsim flight model.
 183  *
 184  * Revision 1.1  1997/05/29 02:35:04  curt
 185  * Initial revision.
 186  *
 187  */