X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FFDM%2FJSBSim%2FFGJSBBase.h;h=c4d0542460c2b4637dd6b7fcd255fe2ebe75b550;hb=9cd26d8b341fa32b617bb9ab851e0d557b7e0344;hp=c09104c9a39a32e51a238cd49d6163fbc6b01d06;hpb=ef62644c96b6b4ff87b82c91887d9b325a26d88d;p=flightgear.git diff --git a/src/FDM/JSBSim/FGJSBBase.h b/src/FDM/JSBSim/FGJSBBase.h index c09104c9a..c4d054246 100644 --- a/src/FDM/JSBSim/FGJSBBase.h +++ b/src/FDM/JSBSim/FGJSBBase.h @@ -7,20 +7,20 @@ ------------- Copyright (C) 2001 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 + the terms of the GNU Lesser 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 + FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public License for more details. - You should have received a copy of the GNU General Public License along with + You should have received a copy of the GNU Lesser 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 + Further information about the GNU Lesser General Public License can also be found on the world wide web at http://www.gnu.org. HISTORY @@ -39,54 +39,20 @@ INCLUDES %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/ #include - -#ifdef FGFS -# include -# include -# include -# include STL_STRING - -SG_USING_STD(string); - -# ifndef M_PI -# include -# define M_PI SG_PI -# endif - -#else // JSBSim section - -# include -# include -# if defined(sgi) && !defined(__GNUC__) -# include -# else -# include -# endif - -using std::string; - -# if defined(_MSC_VER) && _MSC_VER <= 1200 -# ifndef max -# define max(a,b) (((a) > (b)) ? (a) : (b)) -# endif - -# ifndef min -# define min(a,b) (((a) < (b)) ? (a) : (b)) -# endif -# else +#include +#include +#include +#include using std::fabs; +using std::string; -# endif - -# ifndef M_PI -# define M_PI 3.14159265358979323846 -# endif - +#ifndef M_PI +# define M_PI 3.14159265358979323846 #endif #if !defined(WIN32) || defined(__GNUC__) || (defined(_MSC_VER) && (_MSC_VER >= 1300)) -using std::max; + using std::max; #endif /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% @@ -125,7 +91,8 @@ public: ~FGJSBBase() {}; /// JSBSim Message structure - typedef struct Msg { + class Message { + public: unsigned int fdmId; unsigned int messageId; string text; @@ -134,7 +101,28 @@ public: bool bVal; int iVal; double dVal; - } Message; + }; + + /// First order, (low pass / lag) filter + class Filter { + double prev_in; + double prev_out; + double ca; + double cb; + public: Filter(void) {} + public: Filter(double coeff, double dt) { + prev_in = prev_out = 0.0; + double denom = 2.0 + coeff*dt; + ca = coeff*dt/denom; + cb = (2.0 - coeff*dt)/denom; + } + public: double execute(double in) { + double out = (in + prev_in)*ca + prev_out*cb; + prev_in = in; + prev_out = out; + return out; + } + }; ///@name JSBSim console output highlighting terms. //@{ @@ -167,29 +155,29 @@ public: /** Places a Message structure on the Message queue. @param msg pointer to a Message structure @return pointer to a Message structure */ - Message* PutMessage(Message* msg); +void PutMessage(const Message& msg); /** Creates a message with the given text and places it on the queue. @param text message text @return pointer to a Message structure */ - Message* PutMessage(const string& text); + void PutMessage(const string& text); /** Creates a message with the given text and boolean value and places it on the queue. @param text message text @param bVal boolean value associated with the message @return pointer to a Message structure */ - Message* PutMessage(const string& text, bool bVal); +void PutMessage(const string& text, bool bVal); /** Creates a message with the given text and integer value and places it on the queue. @param text message text @param iVal integer value associated with the message @return pointer to a Message structure */ - Message* PutMessage(const string& text, int iVal); +void PutMessage(const string& text, int iVal); /** Creates a message with the given text and double value and places it on the queue. @param text message text @param dVal double value associated with the message @return pointer to a Message structure */ - Message* PutMessage(const string& text, double dVal); +void PutMessage(const string& text, double dVal); /** Reads the message on the queue (but does not delete it). - @return pointer to a Message structure (or NULL if no mesage) */ - Message* ReadMessage(void); + @return 1 if some messages */ + int SomeMessages(void); /** Reads the message on the queue and removes it from the queue. @return pointer to a Message structure (or NULL if no mesage) */ Message* ProcessMessage(void); @@ -211,6 +199,13 @@ public: return 1.8*kelvin - 459.4; } + /** Converts from degrees Celsius to degrees Rankine. + * @param celsius The temperature in degrees Celsius. + * @return The temperature in Rankine. */ + static double CelsiusToRankine (double celsius) { + return celsius * 1.8 + 491.67; + } + /** Converts from degrees Rankine to degrees Celsius. * @param rankine The temperature in degrees Rankine. * @return The temperature in Celsius. */ @@ -218,6 +213,20 @@ public: return (rankine - 491.67)/1.8; } + /** Converts from degrees Kelvin to degrees Rankine. + * @param kelvin The temperature in degrees Kelvin. + * @return The temperature in Rankine. */ + static double KelvinToRankine (double kelvin) { + return kelvin * 1.8; + } + + /** Converts from degrees Rankine to degrees Kelvin. + * @param rankine The temperature in degrees Rankine. + * @return The temperature in Kelvin. */ + static double RankineToKelvin (double rankine) { + return rankine/1.8; + } + /** Converts from degrees Fahrenheit to degrees Celsius. * @param fahrenheit The temperature in degrees Fahrenheit. * @return The temperature in Celsius. */ @@ -232,6 +241,20 @@ public: return celsius * 1.8 + 32.0; } + /** Converts from degrees Celsius to degrees Kelvin + * @param celsius The temperature in degrees Celsius. + * @return The temperature in Kelvin. */ + static double CelsiusToKelvin (double celsius) { + return celsius + 273.15; + } + + /** Converts from degrees Kelvin to degrees Celsius + * @param celsius The temperature in degrees Kelvin. + * @return The temperature in Celsius. */ + static double KelvinToCelsius (double kelvin) { + return kelvin - 273.15; + } + /** Finite precision comparison. @param a first value to compare @param b second value to compare @@ -265,15 +288,20 @@ public: static bool EqualToRoundoff(double a, float b) { return EqualToRoundoff((float)a, b); } + + /** Constrain a value between a minimum and a maximum value. + */ + static double Constrain(double min, double value, double max) { + return valuemax?(max):(value)); + } protected: static Message localMsg; - static std::queue Messages; + static std::queue Messages; void Debug(int from) {}; - static unsigned int frame; static unsigned int messageId; static const double radtodeg; @@ -285,13 +313,27 @@ protected: static const double ktstofps; static const double inchtoft; static const double in3tom3; + static const double m3toft3; + static const double inhgtopa; + static const double fttom; static double Reng; // Specific Gas Constant,ft^2/(sec^2*R) static const double SHRatio; static const double lbtoslug; static const double slugtolb; + static const double kgtolb; + static const double kgtoslug; static const string needed_cfg_version; static const string JSBSim_version; + static string CreateIndexedPropertyName(string Property, int index) + { + std::stringstream str; + str << index; + string tmp; + str >> tmp; + return Property + "[" + tmp + "]"; + } + public: /// Moments L, M, N enum {eL = 1, eM, eN };