src/FDM/LaRCsim/LaRCsimIC.hxx

   1 /*******************************************************************************
   2
   3  Header:       LaRCsimIC.hxx
   4  Author:       Tony Peden
   5  Date started: 10/9/00
   6
   7  ------------- Copyright (C) 2000 Anthony K. Peden (apeden@earthlink.net) -------------
   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
  20  along with this program; if not, write to the Free Software
  21  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, 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 #ifndef _LARCSIMIC_HXX
  27 #define _LARCSIMIC_HXX
  28
  29 /*******************************************************************************
  30 INCLUDES
  31 *******************************************************************************/
  32
  33 #include "ls_constants.h"
  34 #include "ls_types.h"
  35
  36 /*******************************************************************************
  37 CLASS DECLARATION
  38 *******************************************************************************/
  39
  40 #define KTS_TO_FPS 1.6889
  41 #define M_TO_FT 3.2808399
  42 #define DEFAULT_AGL_ALT 3.758099
  43 #define DEFAULT_PITCH_ON_GROUND 0.0074002
  44
  45 enum lsspeedset { lssetvt, lssetvc, lssetve, lssetmach, lssetuvw, lssetned };
  46 enum lsaltset { lssetasl, lssetagl };
  47
  48
  49 class LaRCsimIC {
  50 public:
  51
  52   LaRCsimIC(void);
  53   ~LaRCsimIC(void);
  54
  55   void SetVcalibratedKtsIC(SCALAR tt);
  56   void SetMachIC(SCALAR tt);
  57
  58   void SetVtrueFpsIC(SCALAR tt);
  59
  60   void SetVequivalentKtsIC(SCALAR tt);
  61
  62   void SetUVWFpsIC(SCALAR vu, SCALAR vv, SCALAR vw);
  63
  64   void SetVNEDFpsIC(SCALAR north, SCALAR east, SCALAR down);
  65
  66   void SetVNEDAirmassFpsIC(SCALAR north, SCALAR east, SCALAR down );
  67
  68   void SetAltitudeFtIC(SCALAR tt);
  69   void SetAltitudeAGLFtIC(SCALAR tt);
  70
  71   //"vertical" flight path, recalculate theta
  72   inline void SetFlightPathAngleDegIC(SCALAR tt) { SetFlightPathAngleRadIC(tt*SGD_DEGREES_TO_RADIANS); }
  73   void SetFlightPathAngleRadIC(SCALAR tt);
  74
  75   //set speed first
  76   void SetClimbRateFpmIC(SCALAR tt);
  77   void SetClimbRateFpsIC(SCALAR tt);
  78
  79   //use currently stored gamma, recalcualte theta
  80   inline void SetAlphaDegIC(SCALAR tt)      { alpha=tt*SGD_DEGREES_TO_RADIANS; getTheta(); }
  81   inline void SetAlphaRadIC(SCALAR tt)      { alpha=tt; getTheta(); }
  82
  83   //use currently stored gamma, recalcualte alpha
  84   inline void SetPitchAngleDegIC(SCALAR tt) { SetPitchAngleRadIC(tt*SGD_DEGREES_TO_RADIANS); }
  85          void SetPitchAngleRadIC(SCALAR tt);
  86
  87   inline void SetBetaDegIC(SCALAR tt)       { beta=tt*SGD_DEGREES_TO_RADIANS; getTheta();}
  88   inline void SetBetaRadIC(SCALAR tt)       { beta=tt; getTheta(); }
  89
  90   inline void SetRollAngleDegIC(SCALAR tt) { phi=tt*SGD_DEGREES_TO_RADIANS; getTheta(); }
  91   inline void SetRollAngleRadIC(SCALAR tt) { phi=tt; getTheta(); }
  92
  93   inline void SetHeadingDegIC(SCALAR tt)   { psi=tt*SGD_DEGREES_TO_RADIANS; }
  94   inline void SetHeadingRadIC(SCALAR tt)   { psi=tt; }
  95
  96   inline void SetLatitudeGDDegIC(SCALAR tt)  { SetLatitudeGDRadIC(tt*SGD_DEGREES_TO_RADIANS); }
  97          void SetLatitudeGDRadIC(SCALAR tt);
  98
  99   inline void SetLongitudeDegIC(SCALAR tt) { longitude=tt*SGD_DEGREES_TO_RADIANS; }
 100   inline void SetLongitudeRadIC(SCALAR tt) { longitude=tt; }
 101
 102   void SetRunwayAltitudeFtIC(SCALAR tt);
 103
 104   inline SCALAR GetVcalibratedKtsIC(void) { return sqrt(density_ratio*vt*vt)*V_TO_KNOTS; }
 105   inline SCALAR GetVequivalentKtsIC(void) { return sqrt(density_ratio)*vt*V_TO_KNOTS; }
 106   inline SCALAR GetVtrueKtsIC(void) { return vt*V_TO_KNOTS; }
 107   inline SCALAR GetVtrueFpsIC(void) { return vt; }
 108   inline SCALAR GetMachIC(void) { return vt/soundspeed; }
 109
 110   inline SCALAR GetAltitudeFtIC(void)    { return altitude; }
 111   inline SCALAR GetAltitudeAGLFtIC(void) { return alt_agl; }
 112
 113   inline SCALAR GetRunwayAltitudeFtIC(void) { return runway_altitude; }
 114
 115   inline SCALAR GetFlightPathAngleDegIC(void) { return gamma*SGD_RADIANS_TO_DEGREES; }
 116   inline SCALAR GetFlightPathAngleRadIC(void) { return gamma; }
 117
 118   inline SCALAR GetClimbRateFpmIC(void) { return hdot*60; }
 119   inline SCALAR GetClimbRateFpsIC(void) { return hdot; }
 120
 121   inline SCALAR GetAlphaDegIC(void)      { return alpha*SGD_RADIANS_TO_DEGREES; }
 122   inline SCALAR GetAlphaRadIC(void)      { return alpha; }
 123
 124   inline SCALAR GetPitchAngleDegIC(void) { return theta*SGD_RADIANS_TO_DEGREES; }
 125   inline SCALAR GetPitchAngleRadIC(void) { return theta; }
 126
 127
 128   inline SCALAR GetBetaDegIC(void)       { return beta*SGD_RADIANS_TO_DEGREES; }
 129   inline SCALAR GetBetaRadIC(void)       { return beta*SGD_RADIANS_TO_DEGREES; }
 130
 131   inline SCALAR GetRollAngleDegIC(void) { return phi*SGD_RADIANS_TO_DEGREES; }
 132   inline SCALAR GetRollAngleRadIC(void) { return phi; }
 133
 134   inline SCALAR GetHeadingDegIC(void)   { return psi*SGD_RADIANS_TO_DEGREES; }
 135   inline SCALAR GetHeadingRadIC(void)   { return psi; }
 136
 137   inline SCALAR GetLatitudeGDDegIC(void)  { return latitude_gd*SGD_RADIANS_TO_DEGREES; }
 138   inline SCALAR GetLatitudeGDRadIC(void) { return latitude_gd; }
 139
 140   inline SCALAR GetLongitudeDegIC(void) { return longitude*SGD_RADIANS_TO_DEGREES; }
 141   inline SCALAR GetLongitudeRadIC(void) { return longitude; }
 142
 143   inline SCALAR GetUBodyFpsIC(void) { return vt*cos(alpha)*cos(beta); }
 144   inline SCALAR GetVBodyFpsIC(void) { return vt*sin(beta); }
 145   inline SCALAR GetWBodyFpsIC(void) { return vt*sin(alpha)*cos(beta); }
 146
 147   inline SCALAR GetVnorthFpsIC(void) { calcNEDfromVt();return vnorth; }
 148   inline SCALAR GetVeastFpsIC(void)  { calcNEDfromVt();return veast; }
 149   inline SCALAR GetVdownFpsIC(void)  { calcNEDfromVt();return vdown; }
 150
 151   inline SCALAR GetVnorthAirmassFpsIC(void) { return vnorthwind; }
 152   inline SCALAR GetVeastAirmassFpsIC(void)  { return veastwind; }
 153   inline SCALAR GetVdownAirmassFpsIC(void)  { return vdownwind; }
 154
 155   inline SCALAR GetThetaRadIC(void) { return theta; }
 156   inline SCALAR GetPhiRadIC(void)   { return phi; }
 157   inline SCALAR GetPsiRadIC(void)   { return psi; }
 158
 159
 160
 161 private:
 162   SCALAR vt,vtg,vw,vc,ve;
 163   SCALAR alpha,beta,gamma,theta,phi,psi;
 164   SCALAR mach;
 165   SCALAR altitude,runway_altitude,hdot,alt_agl,sea_level_radius;
 166   SCALAR latitude_gd,latitude_gc,longitude;
 167   SCALAR u,v,w;
 168   SCALAR vnorth,veast,vdown;
 169   SCALAR vnorthwind, veastwind, vdownwind;
 170   SCALAR p,T,soundspeed,density_ratio,rho;
 171
 172   SCALAR xlo, xhi,xmin,xmax;
 173
 174   typedef SCALAR (LaRCsimIC::*fp)(SCALAR x);
 175   fp sfunc;
 176
 177   lsspeedset lastSpeedSet;
 178   lsaltset lastAltSet;
 179
 180
 181   void calcVtfromNED(void);
 182   void calcNEDfromVt(void);
 183   void calcSpeeds(void);
 184
 185
 186   bool getAlpha(void);
 187   bool getTheta(void);
 188   SCALAR GammaEqOfTheta(SCALAR tt);
 189   SCALAR GammaEqOfAlpha(SCALAR tt);
 190   void get_atmosphere(void);
 191
 192
 193   bool findInterval(SCALAR x,SCALAR guess);
 194   bool solve(SCALAR *y, SCALAR x);
 195 };
 196
 197 #endif