]> git.mxchange.org Git - flightgear.git/blobdiff - src/FDM/JSBSim/FGFDMExec.cpp
Latest JSBSim changes.
[flightgear.git] / src / FDM / JSBSim / FGFDMExec.cpp
index 30a274675b1d728a7f456aec3238df00dd2ef82d..806a08b21959719cf9a26d1437be95989bd4c882 100644 (file)
@@ -43,17 +43,14 @@ INCLUDES
 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
 
 #ifdef FGFS
-#  include <time.h>
 #  include <simgear/compiler.h>
 #  include STL_IOSTREAM
 #  include STL_ITERATOR
 #else
 #  if defined(sgi) && !defined(__GNUC__)
 #    include <iostream.h>
-#    include <time.h>
 #  else
 #    include <iostream>
-#    include <ctime>
 #  endif
 #  include <iterator>
 #endif
@@ -74,6 +71,7 @@ INCLUDES
 #include "FGAuxiliary.h"
 #include "FGOutput.h"
 #include "FGConfigFile.h"
+#include "FGInitialCondition.h"
 
 static const char *IdSrc = "$Id$";
 static const char *IdHdr = ID_FDMEXEC;
@@ -102,6 +100,8 @@ short debug_lvl;  // This describes to any interested entity the debug level
                   // g) 16: When set various parameters are sanity checked and
                   //    a message is printed out when they go out of bounds.
 
+unsigned int FGFDMExec::FDMctr = 0;
+
 /*%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
 CLASS IMPLEMENTATION
 %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%*/
@@ -133,6 +133,9 @@ FGFDMExec::FGFDMExec(void)
   modelLoaded = false;
   Scripted = false;
 
+  IdFDM = FDMctr;
+  FDMctr++;
+
   try {
     char* num = getenv("JSBSIM_DEBUG");
     if (!num) debug_lvl = 1;
@@ -141,29 +144,24 @@ FGFDMExec::FGFDMExec(void)
     debug_lvl = 1;
   }
 
-  if (debug_lvl > 0) {
-    cout << "\n\n     " << highint << underon << "JSBSim Flight Dynamics Model v"
-                                   << JSBSIM_VERSION << underoff << normint << endl;
-    cout << halfint << "            [cfg file spec v" << NEEDED_CFG_VERSION << "]\n\n";
-    cout << normint << "JSBSim startup beginning ...\n\n";
-  }
-
-  if (debug_lvl & 2) cout << "Instantiated: FGFDMExec" << endl;
+  Debug(0);
 
   Allocate();
 }
 
 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
 
-FGFDMExec::~FGFDMExec() {
+FGFDMExec::~FGFDMExec()
+{
   DeAllocate();
-  if (debug_lvl & 2) cout << "Destroyed:    FGFDMExec" << endl;
+
+  Debug(1);
 }
 
 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
 
-bool FGFDMExec::Allocate(void) {
-
+bool FGFDMExec::Allocate(void)
+{
   bool result=true;
 
   Atmosphere      = new FGAtmosphere(this);
@@ -315,6 +313,7 @@ int FGFDMExec::Schedule(FGModel* model, int rate)
     model_iterator->NextModel->SetRate(rate);
 
   }
+  
   return 0;
 }
 
@@ -334,16 +333,14 @@ bool FGFDMExec::Run(void)
     if (State->Getsim_time() >= EndTime) return false;
   }
 
-  if (debug_lvl & 4)
-    cout << "================== Frame: " << Frame << "  Time: "
-         << State->Getsim_time() << endl;
+  Debug(2);
 
   while (!model_iterator->Run()) {
     model_iterator = model_iterator->NextModel;
     if (model_iterator == 0L) break;
   }
 
-  Frame++;
+  frame = Frame++;
   State->IncrTime();
 
   return true;
@@ -389,13 +386,13 @@ bool FGFDMExec::LoadModel(string APath, string EPath, string model)
 
   if (result) {
     modelLoaded = true;
+    Debug(3);
   } else {
     cerr << fgred
-         << "FGFDMExec: Failed to load aircraft and/or engine model"
+         << "  FGFDMExec: Failed to load aircraft and/or engine model"
          << fgdef << endl;
   }
 
-  if (debug_lvl > 0) cout << "\n\nJSBSim startup complete\n\n";
   return result;
 }
 
@@ -407,9 +404,9 @@ bool FGFDMExec::LoadScript(string script)
   string token="";
   string aircraft="";
   string initialize="";
-  bool result=false;
-  float dt=0.0;
-  int i;
+  bool result = false;
+  double dt = 0.0;
+  unsigned i;
   struct condition *newCondition;
 
   if (!Script.IsOpen()) return false;
@@ -419,13 +416,13 @@ bool FGFDMExec::LoadScript(string script)
   Scripted = true;
   if (debug_lvl > 0) cout << "Reading Script File " << ScriptName << endl;
 
-  while (Script.GetNextConfigLine() != "EOF" && Script.GetValue() != "/runscript") {
+  while (Script.GetNextConfigLine() != string("EOF") && Script.GetValue() != string("/runscript")) {
     token = Script.GetValue();
     if (token == "use") {
-      if ((token = Script.GetValue("aircraft")) != "") {
+      if ((token = Script.GetValue("aircraft")) != string("")) {
         aircraft = token;
         if (debug_lvl > 0) cout << "  Use aircraft: " << token << endl;
-      } else if ((token = Script.GetValue("initialize")) != "") {
+      } else if ((token = Script.GetValue("initialize")) != string("")) {
         initialize = token;
         if (debug_lvl > 0) cout << "  Use reset file: " << token << endl;
       } else {
@@ -439,13 +436,13 @@ bool FGFDMExec::LoadScript(string script)
       State->Setdt(dt);
       Script.GetNextConfigLine();
       token = Script.GetValue();
-      while (token != "/run") {
+      while (token != string("/run")) {
 
         if (token == "when") {
           Script.GetNextConfigLine();
           token = Script.GetValue();
           newCondition = new struct condition();
-          while (token != "/when") {
+          while (token != string("/when")) {
             if (token == "parameter") {
               newCondition->TestParam.push_back(State->GetParameterIndex(Script.GetValue("name")));
               newCondition->TestValue.push_back(strtod(Script.GetValue("value").c_str(), NULL));
@@ -491,6 +488,8 @@ bool FGFDMExec::LoadScript(string script)
         }
 
       }
+    } else if (token.empty()) {
+     // do nothing
     } else {
       cerr << "Unrecognized keyword in script file: \"" << token << "\" [runscript] " << endl;
     }
@@ -501,84 +500,19 @@ bool FGFDMExec::LoadScript(string script)
     exit(-1);
   }
 
-  // print out conditions for double-checking if requested
-
-  if (debug_lvl > 0) {
-    vector <struct condition>::iterator iterConditions = Conditions.begin();
-    int count=0;
-
-    cout << "\n  Script goes from " << StartTime << " to " << EndTime
-         << " with dt = " << dt << endl << endl;
-
-    while (iterConditions < Conditions.end()) {
-      cout << "  Condition: " << count++ << endl;
-      cout << "    if (";
-
-      for (i=0; i<iterConditions->TestValue.size(); i++) {
-        if (i>0) cout << " and" << endl << "        ";
-        cout << "(" << State->paramdef[iterConditions->TestParam[i]]
-                    << iterConditions->Comparison[i] << " "
-                    << iterConditions->TestValue[i] << ")";
-      }
-      cout << ") then {" << endl;
-
-      for (i=0; i<iterConditions->SetValue.size(); i++) {
-        cout << "      set" << State->paramdef[iterConditions->SetParam[i]]
-             << "to " << iterConditions->SetValue[i];
-
-        switch (iterConditions->Type[i]) {
-        case FG_VALUE:
-          cout << " (constant";
-          break;
-        case FG_DELTA:
-          cout << " (delta";
-          break;
-        case FG_BOOL:
-          cout << " (boolean";
-          break;
-        default:
-          cout << " (unspecified type";
-        }
-
-        switch (iterConditions->Action[i]) {
-        case FG_RAMP:
-          cout << " via ramp";
-          break;
-        case FG_STEP:
-          cout << " via step";
-          break;
-        case FG_EXP:
-          cout << " via exponential approach";
-          break;
-        default:
-          cout << " via unspecified action";
-        }
-
-        if (!iterConditions->Persistent[i]) cout << endl
-                           << "                              once";
-        else cout << endl
-                           << "                              repeatedly";
-
-        if (iterConditions->Action[i] == FG_RAMP ||
-            iterConditions->Action[i] == FG_EXP) cout << endl
-                           << "                              with time constant "
-                           << iterConditions->TC[i];
-      }
-      cout << ")" << endl << "    }" << endl << endl;
-
-      iterConditions++;
-    }
-
-    cout << endl;
-  }
+  Debug(4);
 
   result = LoadModel("aircraft", "engine", aircraft);
   if (!result) {
     cerr << "Aircraft file " << aircraft << " was not found" << endl;
          exit(-1);
   }
-  if ( ! State->Reset("aircraft", aircraft, initialize))
-                 State->Initialize(2000,0,0,0,0,0,0.5,0.5,40000,0,0,0);
+
+  FGInitialCondition IC(this);
+  if ( ! IC.Load("aircraft", aircraft, initialize)) {
+    cerr << "Initialization unsuccessful" << endl;
+    exit(-1);
+  }
 
   return true;
 }
@@ -588,14 +522,12 @@ bool FGFDMExec::LoadScript(string script)
 void FGFDMExec::RunScript(void)
 {
   vector <struct condition>::iterator iC = Conditions.begin();
-  bool truth;
-  bool WholeTruth;
-  int i;
+  bool truth = false;
+  bool WholeTruth = false;
+  unsigned i;
 
-  int count=0;
-
-  float currentTime = State->Getsim_time();
-  float newSetValue;
+  double currentTime = State->Getsim_time();
+  double newSetValue = 0;
 
   while (iC < Conditions.end()) {
     // determine whether the set of conditional tests for this condition equate
@@ -636,6 +568,7 @@ void FGFDMExec::RunScript(void)
             iC->newValue[i] = iC->OriginalValue[i] + iC->SetValue[i];
             break;
           case FG_BOOL:
+            iC->newValue[i] = iC->SetValue[i];
             break;
           default:
             cerr << "Invalid Type specified" << endl;
@@ -647,7 +580,7 @@ void FGFDMExec::RunScript(void)
 
         switch (iC->Action[i]) {
         case FG_RAMP:
-          newSetValue = (currentTime - iC->StartTime[i])/(iC->TC[i])
+        newSetValue = (currentTime - iC->StartTime[i])/(iC->TC[i])
                       * (iC->newValue[i] - iC->OriginalValue[i]) + iC->OriginalValue[i];
           if (newSetValue > iC->newValue[i]) newSetValue = iC->newValue[i];
           break;
@@ -670,9 +603,119 @@ void FGFDMExec::RunScript(void)
 }
 
 //%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
-
-void FGFDMExec::Debug(void)
+//    The bitmasked value choices are as follows:
+//    unset: In this case (the default) JSBSim would only print
+//       out the normally expected messages, essentially echoing
+//       the config files as they are read. If the environment
+//       variable is not set, debug_lvl is set to 1 internally
+//    0: This requests JSBSim not to output any messages
+//       whatsoever.
+//    1: This value explicity requests the normal JSBSim
+//       startup messages
+//    2: This value asks for a message to be printed out when
+//       a class is instantiated
+//    4: When this value is set, a message is displayed when a
+//       FGModel object executes its Run() method
+//    8: When this value is set, various runtime state variables
+//       are printed out periodically
+//    16: When set various parameters are sanity checked and
+//       a message is printed out when they go out of bounds
+
+void FGFDMExec::Debug(int from)
 {
-    //TODO: Add your source code here
-}
+  unsigned int i;
+
+  if (debug_lvl <= 0) return;
+
+  if (debug_lvl & 1) { // Standard console startup message output
+    if (from == 0) { // Constructor
+      cout << "\n\n     " << highint << underon << "JSBSim Flight Dynamics Model v"
+                                     << JSBSim_version << underoff << normint << endl;
+      cout << halfint << "            [cfg file spec v" << needed_cfg_version << "]\n\n";
+      cout << normint << "JSBSim startup beginning ...\n\n";
+    } else if (from == 3) {
+      cout << "\n\nJSBSim startup complete\n\n";
+    } else if (from == 4)  { // print out script data
+      vector <struct condition>::iterator iterConditions = Conditions.begin();
+      int count=0;
+
+      cout << "\n  Script goes from " << StartTime << " to " << EndTime
+           << " with dt = " << State->Getdt() << endl << endl;
+
+      while (iterConditions < Conditions.end()) {
+        cout << "  Condition: " << count++ << endl;
+        cout << "    if (";
+
+        for (i=0; i<iterConditions->TestValue.size(); i++) {
+          if (i>0) cout << " and" << endl << "        ";
+          cout << "(" << State->paramdef[iterConditions->TestParam[i]]
+                      << iterConditions->Comparison[i] << " "
+                      << iterConditions->TestValue[i] << ")";
+        }
+        cout << ") then {";
 
+        for (i=0; i<iterConditions->SetValue.size(); i++) {
+          cout << endl << "      set" << State->paramdef[iterConditions->SetParam[i]]
+               << "to " << iterConditions->SetValue[i];
+
+          switch (iterConditions->Type[i]) {
+          case FG_VALUE:
+            cout << " (constant";
+            break;
+          case FG_DELTA:
+            cout << " (delta";
+            break;
+          case FG_BOOL:
+            cout << " (boolean";
+            break;
+          default:
+            cout << " (unspecified type";
+          }
+
+          switch (iterConditions->Action[i]) {
+          case FG_RAMP:
+            cout << " via ramp";
+            break;
+          case FG_STEP:
+            cout << " via step";
+            break;
+          case FG_EXP:
+            cout << " via exponential approach";
+            break;
+          default:
+            cout << " via unspecified action";
+          }
+
+          if (!iterConditions->Persistent[i]) cout << endl
+                             << "                              once";
+          else cout << endl
+                             << "                              repeatedly";
+
+          if (iterConditions->Action[i] == FG_RAMP ||
+              iterConditions->Action[i] == FG_EXP) cout << endl
+                             << "                              with time constant "
+                             << iterConditions->TC[i];
+        }
+        cout << ")" << endl << "    }" << endl << endl;
+
+        iterConditions++;
+      }
+
+      cout << endl;
+    }
+  }
+  if (debug_lvl & 2 ) { // Instantiation/Destruction notification
+    if (from == 0) cout << "Instantiated: FGFDMExec" << endl;
+    if (from == 1) cout << "Destroyed:    FGFDMExec" << endl;
+  }
+  if (debug_lvl & 4 ) { // Run() method entry print for FGModel-derived objects
+    if (from == 2) {
+      cout << "================== Frame: " << Frame << "  Time: "
+           << State->Getsim_time() << endl;
+    }
+  }
+  if (debug_lvl & 8 ) { // Runtime state variables
+  }
+  if (debug_lvl & 16) { // Sanity checking
+  }
+}