X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FFDM%2FJSBSim%2FFGJSBBase.h;h=c4d0542460c2b4637dd6b7fcd255fe2ebe75b550;hb=9cd26d8b341fa32b617bb9ab851e0d557b7e0344;hp=93e40fe246a8199f2631b5a7248290a61d62120a;hpb=ac50500e80decf3053526dd6538173203f54d61b;p=flightgear.git diff --git a/src/FDM/JSBSim/FGJSBBase.h b/src/FDM/JSBSim/FGJSBBase.h index 93e40fe24..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 @@ -38,32 +38,21 @@ SENTRY INCLUDES %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/ -#ifdef FGFS -# include -# include -# include -# include STL_STRING - -SG_USING_STD(string); -SG_USING_STD(queue); - -#else - -# include -# include -# if defined(sgi) && !defined(__GNUC__) -# include -# else -# include -# endif +#include +#include +#include +#include +#include +using std::fabs; using std::string; -using std::queue; + +#ifndef M_PI +# define M_PI 3.14159265358979323846 #endif -#ifndef M_PI -# include -# define M_PI SG_PI +#if !defined(WIN32) || defined(__GNUC__) || (defined(_MSC_VER) && (_MSC_VER >= 1300)) + using std::max; #endif /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% @@ -76,78 +65,15 @@ DEFINITIONS FORWARD DECLARATIONS %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/ -enum eParam { - FG_UNDEF = 0, - FG_TIME, - FG_QBAR, - FG_WINGAREA, - FG_WINGSPAN, - FG_CBAR, - FG_ALPHA, - FG_ALPHADOT, - FG_BETA, - FG_ABETA, - FG_BETADOT, - FG_PHI, - FG_THT, - FG_PSI, - FG_PITCHRATE, - FG_ROLLRATE, - FG_YAWRATE, - FG_AEROP, - FG_AEROQ, - FG_AEROR, - FG_CL_SQRD, - FG_MACH, - FG_ALTITUDE, - FG_BI2VEL, - FG_CI2VEL, - FG_ELEVATOR_POS, - FG_AILERON_POS, - FG_RUDDER_POS, - FG_SPDBRAKE_POS, - FG_SPOILERS_POS, - FG_FLAPS_POS, - FG_ELEVATOR_CMD, - FG_AILERON_CMD, - FG_RUDDER_CMD, - FG_SPDBRAKE_CMD, - FG_SPOILERS_CMD, - FG_FLAPS_CMD, - FG_THROTTLE_CMD, - FG_THROTTLE_POS, - FG_MIXTURE_CMD, - FG_MIXTURE_POS, - FG_MAGNETO_CMD, - FG_STARTER_CMD, - FG_ACTIVE_ENGINE, - FG_HOVERB, - FG_PITCH_TRIM_CMD, - FG_YAW_TRIM_CMD, - FG_ROLL_TRIM_CMD, - FG_LEFT_BRAKE_CMD, - FG_CENTER_BRAKE_CMD, - FG_RIGHT_BRAKE_CMD, - FG_SET_LOGGING, - FG_ALPHAH, - FG_ALPHAW, - FG_LBARH, //normalized horizontal tail arm - FG_LBARV, //normalized vertical tail arm - FG_HTAILAREA, - FG_VTAILAREA, - FG_VBARH, //horizontal tail volume - FG_VBARV //vertical tail volume -}; - -/*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% -COMMENTS, REFERENCES, and NOTES [use "class documentation" below for API docs] -%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/ +namespace JSBSim { /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% CLASS DOCUMENTATION %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/ /** JSBSim Base class. +* This class provides universal constants, utility functions, messaging +* functions, and enumerated constants to JSBSim. @author Jon S. Berndt @version $Id$ */ @@ -159,13 +85,14 @@ CLASS DECLARATION class FGJSBBase { public: /// Constructor for FGJSBBase. - FGJSBBase(); + FGJSBBase() {}; /// Destructor for FGJSBBase. - virtual ~FGJSBBase() {}; + ~FGJSBBase() {}; /// JSBSim Message structure - struct Message { + class Message { + public: unsigned int fdmId; unsigned int messageId; string text; @@ -176,26 +103,27 @@ public: double dVal; }; - ///@name JSBSim Enums. - //@{ - /// Moments L, M, N - enum {eL = 1, eM, eN }; - /// Rates P, Q, R - enum {eP = 1, eQ, eR }; - /// Velocities U, V, W - enum {eU = 1, eV, eW }; - /// Positions X, Y, Z - enum {eX = 1, eY, eZ }; - /// Euler angles Phi, Theta, Psi - enum {ePhi = 1, eTht, ePsi }; - /// Stability axis forces, Drag, Side force, Lift - enum {eDrag = 1, eSide, eLift }; - /// Local frame orientation Roll, Pitch, Yaw - enum {eRoll = 1, ePitch, eYaw }; - /// Local frame position North, East, Down - enum {eNorth = 1, eEast, eDown }; - //@} - + /// 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. //@{ /// highlights text @@ -227,57 +155,210 @@ public: /** Places a Message structure on the Message queue. @param msg pointer to a Message structure @return pointer to a Message structure */ - struct Message* PutMessage(struct 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 */ - struct Message* PutMessage(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 */ - struct Message* PutMessage(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 */ - struct Message* PutMessage(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 */ - struct Message* PutMessage(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) */ - struct 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) */ - struct Message* ProcessMessage(void); + Message* ProcessMessage(void); //@} -protected: - static struct Message localMsg; - - static queue Messages; + /** Returns the version number of JSBSim. + * @return The version number of JSBSim. */ + string GetVersion(void) {return JSBSim_version;} - virtual void Debug(void) {}; + /// Disables highlighting in the console output. + void disableHighLighting(void); static short debug_lvl; - static unsigned int frame; - static unsigned int messageId; + + /** Converts from degrees Kelvin to degrees Fahrenheit. + * @param kelvin The temperature in degrees Kelvin. + * @return The temperature in Fahrenheit. */ + static double KelvinToFahrenheit (double kelvin) { + 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. */ + static double RankineToCelsius (double rankine) { + 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. */ + static double FahrenheitToCelsius (double fahrenheit) { + return (fahrenheit - 32.0)/1.8; + } + + /** Converts from degrees Celsius to degrees Fahrenheit. + * @param celsius The temperature in degrees Celsius. + * @return The temperature in Fahrenheit. */ + static double CelsiusToFahrenheit (double celsius) { + 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 + @return if the two values can be considered equal up to roundoff */ + static bool EqualToRoundoff(double a, double b) { + double eps = 2.0*DBL_EPSILON; + return fabs(a - b) <= eps*max(fabs(a), fabs(b)); + } + + /** Finite precision comparison. + @param a first value to compare + @param b second value to compare + @return if the two values can be considered equal up to roundoff */ + static bool EqualToRoundoff(float a, float b) { + float eps = 2.0*FLT_EPSILON; + return fabs(a - b) <= eps*max(fabs(a), fabs(b)); + } + + /** Finite precision comparison. + @param a first value to compare + @param b second value to compare + @return if the two values can be considered equal up to roundoff */ + static bool EqualToRoundoff(float a, double b) { + return EqualToRoundoff(a, (float)b); + } + + /** Finite precision comparison. + @param a first value to compare + @param b second value to compare + @return if the two values can be considered equal up to roundoff */ + 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; + + void Debug(int from) {}; + + static unsigned int messageId; + static const double radtodeg; static const double degtorad; static const double hptoftlbssec; + static const double psftoinhg; + static const double psftopa; static const double fpstokts; static const double ktstofps; static const double inchtoft; - static const double Reng; // Specific Gas Constant,ft^2/(sec^2*R) + 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 }; +/// Rates P, Q, R +enum {eP = 1, eQ, eR }; +/// Velocities U, V, W +enum {eU = 1, eV, eW }; +/// Positions X, Y, Z +enum {eX = 1, eY, eZ }; +/// Euler angles Phi, Theta, Psi +enum {ePhi = 1, eTht, ePsi }; +/// Stability axis forces, Drag, Side force, Lift +enum {eDrag = 1, eSide, eLift }; +/// Local frame orientation Roll, Pitch, Yaw +enum {eRoll = 1, ePitch, eYaw }; +/// Local frame position North, East, Down +enum {eNorth = 1, eEast, eDown }; +/// Locations Radius, Latitude, Longitude +enum {eLat = 1, eLong, eRad }; +/// Conversion specifiers +enum {inNone = 0, inDegrees, inRadians, inMeters, inFeet }; + }; +} //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% #endif