40 #include "FGJSBBase.h" 49 IDENT(IdSrc,
"$Id: FGJSBBase.cpp,v 1.42 2016/01/17 18:42:52 bcoconni Exp $");
50 IDENT(IdHdr,ID_JSBBASE);
57 char FGJSBBase::highint[5] = {27,
'[',
'1',
'm',
'\0' };
58 char FGJSBBase::halfint[5] = {27,
'[',
'2',
'm',
'\0' };
59 char FGJSBBase::normint[6] = {27,
'[',
'2',
'2',
'm',
'\0' };
60 char FGJSBBase::reset[5] = {27,
'[',
'0',
'm',
'\0' };
61 char FGJSBBase::underon[5] = {27,
'[',
'4',
'm',
'\0' };
62 char FGJSBBase::underoff[6] = {27,
'[',
'2',
'4',
'm',
'\0' };
63 char FGJSBBase::fgblue[6] = {27,
'[',
'3',
'4',
'm',
'\0' };
64 char FGJSBBase::fgcyan[6] = {27,
'[',
'3',
'6',
'm',
'\0' };
65 char FGJSBBase::fgred[6] = {27,
'[',
'3',
'1',
'm',
'\0' };
66 char FGJSBBase::fggreen[6] = {27,
'[',
'3',
'2',
'm',
'\0' };
67 char FGJSBBase::fgdef[6] = {27,
'[',
'3',
'9',
'm',
'\0' };
69 char FGJSBBase::highint[5] = {
'\0' };
70 char FGJSBBase::halfint[5] = {
'\0' };
71 char FGJSBBase::normint[6] = {
'\0' };
72 char FGJSBBase::reset[5] = {
'\0' };
73 char FGJSBBase::underon[5] = {
'\0' };
74 char FGJSBBase::underoff[6] = {
'\0' };
75 char FGJSBBase::fgblue[6] = {
'\0' };
76 char FGJSBBase::fgcyan[6] = {
'\0' };
77 char FGJSBBase::fgred[6] = {
'\0' };
78 char FGJSBBase::fggreen[6] = {
'\0' };
79 char FGJSBBase::fgdef[6] = {
'\0' };
82 const double FGJSBBase::radtodeg = 57.295779513082320876798154814105;
83 const double FGJSBBase::degtorad = 0.017453292519943295769236907684886;
84 const double FGJSBBase::hptoftlbssec = 550.0;
85 const double FGJSBBase::psftoinhg = 0.014138;
86 const double FGJSBBase::psftopa = 47.88;
87 const double FGJSBBase::ktstofps = 1.68781;
88 const double FGJSBBase::fpstokts = 1.0/ktstofps;
89 const double FGJSBBase::inchtoft = 0.08333333;
90 const double FGJSBBase::in3tom3 = 1.638706E-5;
91 const double FGJSBBase::m3toft3 = 1.0/(fttom*fttom*fttom);
92 const double FGJSBBase::inhgtopa = 3386.38;
93 const double FGJSBBase::fttom = 0.3048;
94 double FGJSBBase::Reng = 1716.56;
95 double FGJSBBase::Rstar = 1545.348;
96 double FGJSBBase::Mair = 28.9645;
97 const double FGJSBBase::SHRatio = 1.40;
105 const double FGJSBBase::slugtolb = 32.174049;
106 const double FGJSBBase::lbtoslug = 1.0/slugtolb;
107 const double FGJSBBase::kgtolb = 2.20462;
108 const double FGJSBBase::kgtoslug = 0.06852168;
110 const string FGJSBBase::needed_cfg_version =
"2.0";
111 const string FGJSBBase::JSBSim_version =
"1.0 " __DATE__
" " __TIME__ ;
113 queue <FGJSBBase::Message> FGJSBBase::Messages;
114 FGJSBBase::Message FGJSBBase::localMsg;
115 unsigned int FGJSBBase::messageId = 0;
117 int FGJSBBase::gaussian_random_number_phase = 0;
119 short FGJSBBase::debug_lvl = 1;
123 void FGJSBBase::PutMessage(
const Message& msg)
130 void FGJSBBase::PutMessage(
const string& text)
134 msg.messageId = messageId++;
135 msg.subsystem =
"FDM";
136 msg.type = Message::eText;
142 void FGJSBBase::PutMessage(
const string& text,
bool bVal)
146 msg.messageId = messageId++;
147 msg.subsystem =
"FDM";
148 msg.type = Message::eBool;
155 void FGJSBBase::PutMessage(
const string& text,
int iVal)
159 msg.messageId = messageId++;
160 msg.subsystem =
"FDM";
161 msg.type = Message::eInteger;
168 void FGJSBBase::PutMessage(
const string& text,
double dVal)
172 msg.messageId = messageId++;
173 msg.subsystem =
"FDM";
174 msg.type = Message::eDouble;
181 void FGJSBBase::ProcessMessage(
void)
183 if (Messages.empty())
return;
184 localMsg = Messages.front();
186 while (SomeMessages()) {
187 switch (localMsg.type) {
188 case JSBSim::FGJSBBase::Message::eText:
189 cout << localMsg.messageId <<
": " << localMsg.text << endl;
191 case JSBSim::FGJSBBase::Message::eBool:
192 cout << localMsg.messageId <<
": " << localMsg.text <<
" " << localMsg.bVal << endl;
194 case JSBSim::FGJSBBase::Message::eInteger:
195 cout << localMsg.messageId <<
": " << localMsg.text <<
" " << localMsg.iVal << endl;
197 case JSBSim::FGJSBBase::Message::eDouble:
198 cout << localMsg.messageId <<
": " << localMsg.text <<
" " << localMsg.dVal << endl;
201 cerr <<
"Unrecognized message type." << endl;
205 if (SomeMessages()) localMsg = Messages.front();
215 if (Messages.empty())
return NULL;
216 localMsg = Messages.front();
224 void FGJSBBase::disableHighLighting(
void)
241 string FGJSBBase::CreateIndexedPropertyName(
const string& Property,
int index)
244 buf << Property <<
'[' << index <<
']';
250 double FGJSBBase::GaussianRandomNumber(
void)
252 static double V1, V2, S;
255 if (gaussian_random_number_phase == 0) {
256 V1 = V2 = S = X = 0.0;
259 double U1 = (double)rand() / RAND_MAX;
260 double U2 = (double)rand() / RAND_MAX;
264 S = V1 * V1 + V2 * V2;
265 }
while(S >= 1 || S == 0);
267 X = V1 * sqrt(-2 * log(S) / S);
269 X = V2 * sqrt(-2 * log(S) / S);
271 gaussian_random_number_phase = 1 - gaussian_random_number_phase;
278 double FGJSBBase::PitotTotalPressure(
double mach,
double p)
280 if (mach < 0)
return p;
282 return p*pow((1 + 0.2*mach*mach),3.5);
299 return p*166.92158*pow(mach,7.0)/pow(7*mach*mach-1,2.5);
305 double FGJSBBase::VcalibratedFromMach(
double mach,
double p,
double psl,
double rhosl)
307 double pt = PitotTotalPressure(mach, p);
308 double A = pow(((pt-p)/psl+1), 1./3.5);
310 return sqrt(7*psl/rhosl*(A-1));
315 double FGJSBBase::MachFromVcalibrated(
double vcas,
double p,
double psl,
double rhosl)
317 double pt = p + psl*(pow(1+vcas*vcas*rhosl/(7.0*psl),3.5)-1);
320 return sqrt(5.0*(pow(pt/p, 1./3.5) -1));
323 double mach = sqrt(0.77666*pt/p);
325 double target = pt/(166.92158*p);
331 while (delta > 1E-5 && iter < 10) {
332 double m2 = mach*mach;
333 double m6 = m2*m2*m2;
334 delta = mach*m6/pow(7.0*m2-1.0,2.5) - target;
335 double diff = 7.0*m6*(2.0*m2-1)/pow(7.0*m2-1.0,3.5);
JSBSim Message structure.