X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FFDM%2FJSBSim%2FFGJSBBase.cpp;h=a361a37d256732250ebef9803ba2fd9c8e5b23f1;hb=c44948041b9356c9d16acc2d888de109bf7866e7;hp=1b8a36d494c2b9711beb5c40fd5009269d4842bf;hpb=2297c706e8c707c050f75696d5e399798b103434;p=flightgear.git diff --git a/src/FDM/JSBSim/FGJSBBase.cpp b/src/FDM/JSBSim/FGJSBBase.cpp index 1b8a36d49..a361a37d2 100644 --- a/src/FDM/JSBSim/FGJSBBase.cpp +++ b/src/FDM/JSBSim/FGJSBBase.cpp @@ -5,23 +5,23 @@ Date started: 07/01/01 Purpose: Encapsulates the JSBBase object - ------------- Copyright (C) 2001 Jon S. Berndt (jsb@hal-pc.org) ------------- + ------------- Copyright (C) 2001 Jon S. Berndt (jon@jsbsim.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. FUNCTIONAL DESCRIPTION @@ -35,26 +35,250 @@ HISTORY INCLUDES %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/ +#define BASE + #include "FGJSBBase.h" +#include +#include +#include + +namespace JSBSim { -static const char *IdSrc = "$Id$"; +static const char *IdSrc = "$Id: FGJSBBase.cpp,v 1.29 2010/03/18 13:19:21 jberndt Exp $"; static const char *IdHdr = ID_JSBBASE; /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% CLASS IMPLEMENTATION %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/ -char FGJSBBase::highint[5] = {27, '[', '1', 'm', '\0' }; -char FGJSBBase::halfint[5] = {27, '[', '2', 'm', '\0' }; -char FGJSBBase::normint[6] = {27, '[', '2', '2', 'm', '\0' }; -char FGJSBBase::reset[5] = {27, '[', '0', 'm', '\0' }; -char FGJSBBase::underon[5] = {27, '[', '4', 'm', '\0' }; -char FGJSBBase::underoff[6] = {27, '[', '2', '4', 'm', '\0' }; -char FGJSBBase::fgblue[6] = {27, '[', '3', '4', 'm', '\0' }; -char FGJSBBase::fgcyan[6] = {27, '[', '3', '6', 'm', '\0' }; -char FGJSBBase::fgred[6] = {27, '[', '3', '1', 'm', '\0' }; -char FGJSBBase::fggreen[6] = {27, '[', '3', '2', 'm', '\0' }; -char FGJSBBase::fgdef[6] = {27, '[', '3', '9', 'm', '\0' }; - -short FGJSBBase::debug_lvl = 0; +#ifndef _MSC_VER + char FGJSBBase::highint[5] = {27, '[', '1', 'm', '\0' }; + char FGJSBBase::halfint[5] = {27, '[', '2', 'm', '\0' }; + char FGJSBBase::normint[6] = {27, '[', '2', '2', 'm', '\0' }; + char FGJSBBase::reset[5] = {27, '[', '0', 'm', '\0' }; + char FGJSBBase::underon[5] = {27, '[', '4', 'm', '\0' }; + char FGJSBBase::underoff[6] = {27, '[', '2', '4', 'm', '\0' }; + char FGJSBBase::fgblue[6] = {27, '[', '3', '4', 'm', '\0' }; + char FGJSBBase::fgcyan[6] = {27, '[', '3', '6', 'm', '\0' }; + char FGJSBBase::fgred[6] = {27, '[', '3', '1', 'm', '\0' }; + char FGJSBBase::fggreen[6] = {27, '[', '3', '2', 'm', '\0' }; + char FGJSBBase::fgdef[6] = {27, '[', '3', '9', 'm', '\0' }; +#else + char FGJSBBase::highint[5] = {'\0' }; + char FGJSBBase::halfint[5] = {'\0' }; + char FGJSBBase::normint[6] = {'\0' }; + char FGJSBBase::reset[5] = {'\0' }; + char FGJSBBase::underon[5] = {'\0' }; + char FGJSBBase::underoff[6] = {'\0' }; + char FGJSBBase::fgblue[6] = {'\0' }; + char FGJSBBase::fgcyan[6] = {'\0' }; + char FGJSBBase::fgred[6] = {'\0' }; + char FGJSBBase::fggreen[6] = {'\0' }; + char FGJSBBase::fgdef[6] = {'\0' }; +#endif + +const double FGJSBBase::radtodeg = 57.295779513082320876798154814105; +const double FGJSBBase::degtorad = 0.017453292519943295769236907684886; +const double FGJSBBase::hptoftlbssec = 550.0; +const double FGJSBBase::psftoinhg = 0.014138; +const double FGJSBBase::psftopa = 47.88; +const double FGJSBBase::fpstokts = 0.592484; +const double FGJSBBase::ktstofps = 1.68781; +const double FGJSBBase::inchtoft = 0.08333333; +const double FGJSBBase::in3tom3 = 1.638706E-5; +const double FGJSBBase::m3toft3 = 1.0/(fttom*fttom*fttom); +const double FGJSBBase::inhgtopa = 3386.38; +const double FGJSBBase::fttom = 0.3048; +double FGJSBBase::Reng = 1716.0; +const double FGJSBBase::SHRatio = 1.40; + +// Note that definition of lbtoslug by the inverse of slugtolb and not +// to a different constant you can also get from some tables will make +// lbtoslug*slugtolb == 1 up to the magnitude of roundoff. So converting from +// slug to lb and back will yield to the original value you started with up +// to the magnitude of roundoff. +// Taken from units gnu commandline tool +const double FGJSBBase::slugtolb = 32.174049; +const double FGJSBBase::lbtoslug = 1.0/slugtolb; +const double FGJSBBase::kgtolb = 2.20462; +const double FGJSBBase::kgtoslug = 0.06852168; + +const string FGJSBBase::needed_cfg_version = "2.0"; +const string FGJSBBase::JSBSim_version = "1.0 "__DATE__" "__TIME__; + +std::queue FGJSBBase::Messages; +FGJSBBase::Message FGJSBBase::localMsg; +unsigned int FGJSBBase::messageId = 0; + +short FGJSBBase::debug_lvl = 1; + +using std::cerr; +using std::cout; +using std::endl; + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +void FGJSBBase::PutMessage(const Message& msg) +{ + Messages.push(msg); +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +void FGJSBBase::PutMessage(const string& text) +{ + Message msg; + msg.text = text; + msg.messageId = messageId++; + msg.subsystem = "FDM"; + msg.type = Message::eText; + Messages.push(msg); +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +void FGJSBBase::PutMessage(const string& text, bool bVal) +{ + Message msg; + msg.text = text; + msg.messageId = messageId++; + msg.subsystem = "FDM"; + msg.type = Message::eBool; + msg.bVal = bVal; + Messages.push(msg); +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +void FGJSBBase::PutMessage(const string& text, int iVal) +{ + Message msg; + msg.text = text; + msg.messageId = messageId++; + msg.subsystem = "FDM"; + msg.type = Message::eInteger; + msg.bVal = (iVal != 0); + Messages.push(msg); +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +void FGJSBBase::PutMessage(const string& text, double dVal) +{ + Message msg; + msg.text = text; + msg.messageId = messageId++; + msg.subsystem = "FDM"; + msg.type = Message::eDouble; + msg.bVal = (dVal != 0.0); + Messages.push(msg); +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +int FGJSBBase::SomeMessages(void) +{ + return !Messages.empty(); +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +void FGJSBBase::ProcessMessage(void) +{ + if (Messages.empty()) return; + localMsg = Messages.front(); + + while (Messages.size() > 0) { + switch (localMsg.type) { + case JSBSim::FGJSBBase::Message::eText: + cout << localMsg.messageId << ": " << localMsg.text << endl; + break; + case JSBSim::FGJSBBase::Message::eBool: + cout << localMsg.messageId << ": " << localMsg.text << " " << localMsg.bVal << endl; + break; + case JSBSim::FGJSBBase::Message::eInteger: + cout << localMsg.messageId << ": " << localMsg.text << " " << localMsg.iVal << endl; + break; + case JSBSim::FGJSBBase::Message::eDouble: + cout << localMsg.messageId << ": " << localMsg.text << " " << localMsg.dVal << endl; + break; + default: + cerr << "Unrecognized message type." << endl; + break; + } + Messages.pop(); + if (Messages.size() > 0) localMsg = Messages.front(); + else break; + } + +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +FGJSBBase::Message* FGJSBBase::ProcessNextMessage(void) +{ + if (Messages.empty()) return NULL; + localMsg = Messages.front(); + + Messages.pop(); + return &localMsg; +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +void FGJSBBase::disableHighLighting(void) { + highint[0]='\0'; + halfint[0]='\0'; + normint[0]='\0'; + reset[0]='\0'; + underon[0]='\0'; + underoff[0]='\0'; + fgblue[0]='\0'; + fgcyan[0]='\0'; + fgred[0]='\0'; + fggreen[0]='\0'; + fgdef[0]='\0'; +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +string FGJSBBase::CreateIndexedPropertyName(const string& Property, int index) +{ + std::ostringstream buf; + buf << Property << '[' << index << ']'; + return buf.str(); +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +double FGJSBBase::GaussianRandomNumber(void) +{ + static double V1, V2, S; + static int phase = 0; + double X; + + if (phase == 0) { + V1 = V2 = S = X = 0.0; + + do { + double U1 = (double)rand() / RAND_MAX; + double U2 = (double)rand() / RAND_MAX; + + V1 = 2 * U1 - 1; + V2 = 2 * U2 - 1; + S = V1 * V1 + V2 * V2; + } while(S >= 1 || S == 0); + + X = V1 * sqrt(-2 * log(S) / S); + } else + X = V2 * sqrt(-2 * log(S) / S); + + phase = 1 - phase; + + return X; +} + +//%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% + +} // namespace JSBSim