X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FFDM%2FJSBSim%2FFGJSBBase.cpp;h=a361a37d256732250ebef9803ba2fd9c8e5b23f1;hb=c44948041b9356c9d16acc2d888de109bf7866e7;hp=fa2da135907fc277e9496a7af64852fd3e28c87b;hpb=5644f22513725d2a41f739065f58122a4dfff4ce;p=flightgear.git diff --git a/src/FDM/JSBSim/FGJSBBase.cpp b/src/FDM/JSBSim/FGJSBBase.cpp index fa2da1359..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,134 +35,191 @@ 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' }; - -const double FGJSBBase::radtodeg = 57.29578; -const double FGJSBBase::degtorad = 1.745329E-2; +#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::Reng = 1716.0; +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; -const string FGJSBBase::needed_cfg_version = "1.60"; -const string FGJSBBase::JSBSim_version = "0.9.4"; -std::queue FGJSBBase::Messages; +// 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; -unsigned int FGJSBBase::frame = 0; +unsigned int FGJSBBase::messageId = 0; short FGJSBBase::debug_lvl = 1; +using std::cerr; +using std::cout; +using std::endl; + //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% -FGJSBBase::FGJSBBase() +void FGJSBBase::PutMessage(const Message& msg) { + Messages.push(msg); } //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% -FGJSBBase::Message* FGJSBBase::PutMessage(Message* 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); - return msg; } //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% -FGJSBBase::Message* FGJSBBase::PutMessage(string text) +void FGJSBBase::PutMessage(const string& text, bool bVal) { - Message *msg = new Message(); - msg->text = text; - msg->messageId = messageId++; - msg->subsystem = "FDM"; - msg->type = Message::eText; + Message msg; + msg.text = text; + msg.messageId = messageId++; + msg.subsystem = "FDM"; + msg.type = Message::eBool; + msg.bVal = bVal; Messages.push(msg); - return msg; } //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% -FGJSBBase::Message* FGJSBBase::PutMessage(string text, bool bVal) +void FGJSBBase::PutMessage(const string& text, int iVal) { - Message *msg = new Message(); - msg->text = text; - msg->messageId = messageId++; - msg->subsystem = "FDM"; - msg->type = Message::eBool; - msg->bVal = bVal; + Message msg; + msg.text = text; + msg.messageId = messageId++; + msg.subsystem = "FDM"; + msg.type = Message::eInteger; + msg.bVal = (iVal != 0); Messages.push(msg); - return msg; } //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% -FGJSBBase::Message* FGJSBBase::PutMessage(string text, int iVal) +void FGJSBBase::PutMessage(const string& text, double dVal) { - Message *msg = new Message(); - msg->text = text; - msg->messageId = messageId++; - msg->subsystem = "FDM"; - msg->type = Message::eInteger; - msg->bVal = (iVal != 0); + Message msg; + msg.text = text; + msg.messageId = messageId++; + msg.subsystem = "FDM"; + msg.type = Message::eDouble; + msg.bVal = (dVal != 0.0); Messages.push(msg); - return msg; } //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% -FGJSBBase::Message* FGJSBBase::PutMessage(string text, double dVal) +int FGJSBBase::SomeMessages(void) { - Message *msg = new Message(); - msg->text = text; - msg->messageId = messageId++; - msg->subsystem = "FDM"; - msg->type = Message::eDouble; - msg->bVal = (dVal != 0.0); - Messages.push(msg); - return msg; + return !Messages.empty(); } //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% -FGJSBBase::Message* FGJSBBase::ReadMessage(void) +void FGJSBBase::ProcessMessage(void) { - if (!Messages.empty()) return Messages.front(); - else return NULL; + 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::ProcessMessage(void) +FGJSBBase::Message* FGJSBBase::ProcessNextMessage(void) { - if (!Messages.empty()) - localMsg = *(Messages.front()); - else - return NULL; + if (Messages.empty()) return NULL; + localMsg = Messages.front(); + Messages.pop(); return &localMsg; } @@ -185,5 +242,43 @@ void FGJSBBase::disableHighLighting(void) { //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% +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