148 lines
4.3 KiB
C++
148 lines
4.3 KiB
C++
/*******************************************************************************
|
|
|
|
Header: FGState.h
|
|
Author: Jon S. Berndt
|
|
Date started: 11/17/98
|
|
|
|
------------- Copyright (C) 1999 Jon S. Berndt (jsb@hal-pc.org) -------------
|
|
|
|
This program is free software; you can redistribute it and/or modify it under
|
|
the terms of the GNU General Public License as published by the Free Software
|
|
Foundation; either version 2 of the License, or (at your option) any later
|
|
version.
|
|
|
|
This program is distributed in the hope that it will be useful, but WITHOUT
|
|
ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
|
|
FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
|
|
details.
|
|
|
|
You should have received a copy of the GNU General Public License along with
|
|
this program; if not, write to the Free Software Foundation, Inc., 59 Temple
|
|
Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
|
|
Further information about the GNU General Public License can also be found on
|
|
the world wide web at http://www.gnu.org.
|
|
|
|
FUNCTIONAL DESCRIPTION
|
|
--------------------------------------------------------------------------------
|
|
|
|
Based on Flightgear code, which is based on LaRCSim. This class wraps all
|
|
global state variables (such as velocity, position, orientation, etc.).
|
|
|
|
HISTORY
|
|
--------------------------------------------------------------------------------
|
|
11/17/98 JSB Created
|
|
|
|
********************************************************************************
|
|
SENTRY
|
|
*******************************************************************************/
|
|
|
|
#ifndef FGSTATE_H
|
|
#define FGSTATE_H
|
|
|
|
/*******************************************************************************
|
|
INCLUDES
|
|
*******************************************************************************/
|
|
|
|
#ifdef FGFS
|
|
# include <simgear/compiler.h>
|
|
# ifdef FG_HAVE_STD_INCLUDES
|
|
# include <fstream>
|
|
# else
|
|
# include <fstream.h>
|
|
# endif
|
|
#else
|
|
# include <fstream>
|
|
#endif
|
|
|
|
#include <string>
|
|
#include <map>
|
|
#include "FGDefs.h"
|
|
#include "FGInitialCondition.h"
|
|
#include "FGMatrix.h"
|
|
|
|
/*******************************************************************************
|
|
DEFINES
|
|
*******************************************************************************/
|
|
|
|
/*******************************************************************************
|
|
CLASS DECLARATION
|
|
*******************************************************************************/
|
|
|
|
class FGFDMExec;
|
|
|
|
class FGState {
|
|
public:
|
|
FGState(FGFDMExec*);
|
|
~FGState(void);
|
|
|
|
bool Reset(string, string, string);
|
|
void Initialize(float, float, float, float, float, float, float, float, float);
|
|
void Initialize(FGInitialCondition *FGIC);
|
|
bool StoreData(string);
|
|
|
|
inline float Getadot(void) { return adot; }
|
|
inline float Getbdot(void) { return bdot; }
|
|
|
|
inline float Geta(void) { return a; }
|
|
|
|
inline float Getsim_time(void) { return sim_time; }
|
|
inline float Getdt(void) { return dt; }
|
|
|
|
inline void Suspend(void) {saved_dt = dt; dt = 0.0;}
|
|
inline void Resume(void) {dt = saved_dt;}
|
|
|
|
float GetParameter(eParam val_idx);
|
|
float GetParameter(string val_string);
|
|
eParam GetParameterIndex(string val_string);
|
|
|
|
inline void Setadot(float tt) { adot = tt; }
|
|
inline void Setbdot(float tt) { bdot = tt; }
|
|
|
|
inline void Seta(float tt) { a = tt; }
|
|
|
|
inline float Setsim_time(float tt) {
|
|
sim_time = tt;
|
|
return sim_time;
|
|
}
|
|
inline void Setdt(float tt) { dt = tt; }
|
|
|
|
void SetParameter(eParam, float);
|
|
|
|
inline float IncrTime(void) {
|
|
sim_time+=dt;
|
|
return sim_time;
|
|
}
|
|
void InitMatrices(float phi, float tht, float psi);
|
|
void CalcMatrices(void);
|
|
void IntegrateQuat(FGColumnVector vPQR, int rate);
|
|
FGColumnVector CalcEuler(void);
|
|
FGMatrix GetTs2b(float alpha, float beta);
|
|
FGMatrix GetTl2b(void) { return mTl2b; }
|
|
FGMatrix GetTb2l(void) { return mTb2l; }
|
|
typedef map<eParam, string> ParamMap;
|
|
ParamMap paramdef;
|
|
|
|
private:
|
|
|
|
float adot, bdot; // alpha dot and beta dot
|
|
float a; // speed of sound
|
|
float sim_time, dt;
|
|
float saved_dt;
|
|
|
|
FGFDMExec* FDMExec;
|
|
FGMatrix mTb2l;
|
|
FGMatrix mTl2b;
|
|
FGMatrix mTs2b;
|
|
FGColumnVector vQtrn;
|
|
|
|
typedef map<string, eParam> CoeffMap;
|
|
CoeffMap coeffdef;
|
|
|
|
protected:
|
|
enum {ePhi=1, eTht, ePsi};
|
|
enum {eP=1, eQ, eR};
|
|
};
|
|
|
|
/******************************************************************************/
|
|
#endif
|