src/FDM/JSBSim/FGState.h

   1 /*******************************************************************************
   2
   3  Header:       FGState.h
   4  Author:       Jon S. Berndt
   5  Date started: 11/17/98
   6
   7  ------------- Copyright (C) 1999  Jon S. Berndt (jsb@hal-pc.org) -------------
   8
   9  This program is free software; you can redistribute it and/or modify it under
  10  the terms of the GNU General Public License as published by the Free Software
  11  Foundation; either version 2 of the License, or (at your option) any later
  12  version.
  13
  14  This program is distributed in the hope that it will be useful, but WITHOUT
  15  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
  16  FOR A PARTICULAR PURPOSE.  See the GNU General Public License for more
  17  details.
  18
  19  You should have received a copy of the GNU General Public License along with
  20  this program; if not, write to the Free Software Foundation, Inc., 59 Temple
  21  Place - Suite 330, Boston, MA  02111-1307, USA.
  22
  23  Further information about the GNU General Public License can also be found on
  24  the world wide web at http://www.gnu.org.
  25
  26 FUNCTIONAL DESCRIPTION
  27 --------------------------------------------------------------------------------
  28
  29 Based on Flightgear code, which is based on LaRCSim. This class wraps all
  30 global state variables (such as velocity, position, orientation, etc.).
  31
  32 HISTORY
  33 --------------------------------------------------------------------------------
  34 11/17/98   JSB   Created
  35
  36 ********************************************************************************
  37 SENTRY
  38 *******************************************************************************/
  39
  40 #ifndef FGSTATE_H
  41 #define FGSTATE_H
  42
  43 /*******************************************************************************
  44 INCLUDES
  45 *******************************************************************************/
  46
  47 #ifdef FGFS
  48 #  include <simgear/compiler.h>
  49 #  ifdef FG_HAVE_STD_INCLUDES
  50 #    include <fstream>
  51 #  else
  52 #    include <fstream.h>
  53 #  endif
  54 #else
  55 #  include <fstream>
  56 #endif
  57
  58 #include <string>
  59 #include <map>
  60 #include "FGDefs.h"
  61 #include "FGInitialCondition.h"
  62 #include "FGMatrix.h"
  63
  64 /*******************************************************************************
  65 DEFINES
  66 *******************************************************************************/
  67
  68 /*******************************************************************************
  69 CLASS DECLARATION
  70 *******************************************************************************/
  71
  72 class FGFDMExec;
  73
  74 class FGState {
  75 public:
  76   FGState(FGFDMExec*);
  77   ~FGState(void);
  78
  79   bool Reset(string, string, string);
  80   void Initialize(float, float, float, float, float, float, float, float, float);
  81   void Initialize(FGInitialCondition *FGIC);
  82   bool StoreData(string);
  83
  84   inline float Getadot(void) { return adot; }
  85   inline float Getbdot(void) { return bdot; }
  86
  87   inline float Geta(void) { return a; }
  88
  89   inline float Getsim_time(void) { return sim_time; }
  90   inline float Getdt(void) { return dt; }
  91
  92   inline void Suspend(void) {saved_dt = dt; dt = 0.0;}
  93   inline void Resume(void)  {dt = saved_dt;}
  94
  95   float GetParameter(eParam val_idx);
  96   float GetParameter(string val_string);
  97   eParam GetParameterIndex(string val_string);
  98
  99   inline void Setadot(float tt) { adot = tt; }
 100   inline void Setbdot(float tt) { bdot = tt; }
 101
 102   inline void Seta(float tt) { a = tt; }
 103
 104   inline float Setsim_time(float tt) {
 105     sim_time = tt;
 106     return sim_time;
 107   }
 108   inline void  Setdt(float tt) { dt = tt; }
 109
 110   void SetParameter(eParam, float);
 111
 112   inline float IncrTime(void) {
 113     sim_time+=dt;
 114     return sim_time;
 115   }
 116   void InitMatrices(float phi, float tht, float psi);
 117   void CalcMatrices(void);
 118   void IntegrateQuat(FGColumnVector vPQR, int rate);
 119   FGColumnVector CalcEuler(void);
 120   FGMatrix GetTs2b(float alpha, float beta);
 121   FGMatrix GetTl2b(void) { return mTl2b; }
 122   FGMatrix GetTb2l(void) { return mTb2l; }
 123   typedef map<eParam, string> ParamMap;
 124   ParamMap paramdef;
 125
 126 private:
 127
 128   float adot, bdot;                 // alpha dot and beta dot
 129   float a;                          // speed of sound
 130   float sim_time, dt;
 131   float saved_dt;
 132
 133   FGFDMExec* FDMExec;
 134   FGMatrix mTb2l;
 135   FGMatrix mTl2b;
 136   FGMatrix mTs2b;
 137   FGColumnVector vQtrn;
 138
 139   typedef map<string, eParam> CoeffMap;
 140   CoeffMap coeffdef;
 141
 142 protected:
 143   enum {ePhi=1, eTht, ePsi};
 144   enum {eP=1, eQ, eR};
 145 };
 146
 147 /******************************************************************************/
 148 #endif