]> git.mxchange.org Git - flightgear.git/blobdiff - src/AIModel/AIManager.cxx
Make the vertical acceleration rate scale with vertical performance. The
[flightgear.git] / src / AIModel / AIManager.cxx
index 9e5e7fb3c9641d0f41415c90106f0443adc47984..207913bb1ff5aae959e33dc829126c7c8c79ddb2 100644 (file)
@@ -1,5 +1,5 @@
 // AIManager.cxx  Based on David Luff's AIMgr:
-// - a global management class for AI objects
+// - a global management type for AI objects
 //
 // Written by David Culp, started October 2003.
 // - davidculp2@comcast.net
 //
 // You should have received a copy of the GNU General Public License
 // along with this program; if not, write to the Free Software
-// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 
-#include <simgear/misc/sg_path.hxx>
-#include <Main/fg_props.hxx>
 #include <Main/globals.hxx>
 
-#include <list>
+#include <Airports/simple.hxx>
+#include <Traffic/TrafficMgr.hxx>
 
 #include "AIManager.hxx"
 #include "AIAircraft.hxx"
 #include "AIBallistic.hxx"
 #include "AIStorm.hxx"
 #include "AIThermal.hxx"
-
-SG_USING_STD(list);
-
+#include "AICarrier.hxx"
+#include "AIStatic.hxx"
+#include "AIMultiplayer.hxx"
 
 FGAIManager::FGAIManager() {
-  initDone = false;
-  numObjects = 0;
   _dt = 0.0;
-  dt_count = 9;
+  mNumAiModels = 0;
+  for (unsigned i = 0; i < FGAIBase::MAX_OBJECTS; ++i)
+    mNumAiTypeModels[i] = 0;
 }
 
 FGAIManager::~FGAIManager() {
-  ai_list_itr = ai_list.begin();
+  ai_list_iterator ai_list_itr = ai_list.begin();
   while(ai_list_itr != ai_list.end()) {
-      delete (*ai_list_itr);
+      (*ai_list_itr)->unbind();
       ++ai_list_itr;
-    }
-  ai_list.clear();
-  ids.clear();
+  }
 }
 
 
 void FGAIManager::init() {
-  int rval;
   root = fgGetNode("sim/ai", true);
-  wind_from_down = fgGetNode("/environment/wind-from-down-fps", true);
-
-  for (int i = 0; i < root->nChildren(); i++) {
-    const SGPropertyNode * entry = root->getChild(i);
-
-    if (!strcmp(entry->getName(), "entry")) {
-      if (!strcmp(entry->getStringValue("type", ""), "aircraft")) { 
-
-        rval = createAircraft( entry->getStringValue("class", ""),
-                               entry->getStringValue("path"),
-                               entry->getDoubleValue("latitude"),
-                               entry->getDoubleValue("longitude"),
-                               entry->getDoubleValue("altitude-ft"),
-                               entry->getDoubleValue("heading"),
-                               entry->getDoubleValue("speed-KTAS"),
-                               0.0, 
-                               entry->getDoubleValue("bank") );
-
-      } else if (!strcmp(entry->getStringValue("type", ""), "ship")) {
-
-        rval = createShip( entry->getStringValue("path"),
-                           entry->getDoubleValue("latitude"),
-                           entry->getDoubleValue("longitude"),
-                           entry->getDoubleValue("altitude-ft"),
-                           entry->getDoubleValue("heading"),
-                           entry->getDoubleValue("speed-KTAS"),
-                           entry->getDoubleValue("rudder") );
-
-      } else if (!strcmp(entry->getStringValue("type", ""), "ballistic")) {
-
-        rval = createBallistic( entry->getStringValue("path"),
-                                entry->getDoubleValue("latitude"),
-                                entry->getDoubleValue("longitude"),
-                                entry->getDoubleValue("altitude-ft"),
-                                entry->getDoubleValue("azimuth"),
-                                entry->getDoubleValue("elevation"),
-                                entry->getDoubleValue("speed") );
-
-      } else if (!strcmp(entry->getStringValue("type", ""), "storm")) {
-
-        rval = createStorm( entry->getStringValue("path"),
-                            entry->getDoubleValue("latitude"),
-                            entry->getDoubleValue("longitude"),
-                            entry->getDoubleValue("altitude-ft"),
-                            entry->getDoubleValue("heading"),
-                            entry->getDoubleValue("speed-KTAS") );
-
-      } else if (!strcmp(entry->getStringValue("type", ""), "thermal")) {
-
-        rval = createThermal( entry->getDoubleValue("latitude"),
-                              entry->getDoubleValue("longitude"),
-                              entry->getDoubleValue("strength-fps"),
-                              entry->getDoubleValue("diameter-ft") );
-
-      }       
+
+  enabled = root->getNode("enabled", true)->getBoolValue();
+  if (!enabled)
+      return;
+
+  wind_from_down_node = fgGetNode("/environment/wind-from-down-fps", true);
+  wind_from_east_node  = fgGetNode("/environment/wind-from-east-fps",true);
+  wind_from_north_node = fgGetNode("/environment/wind-from-north-fps",true);
+
+  user_latitude_node  = fgGetNode("/position/latitude-deg", true);
+  user_longitude_node = fgGetNode("/position/longitude-deg", true);
+  user_altitude_node  = fgGetNode("/position/altitude-ft", true);
+  user_heading_node   = fgGetNode("/orientation/heading-deg", true);
+  user_pitch_node     = fgGetNode("/orientation/pitch-deg", true);
+  user_yaw_node       = fgGetNode("/orientation/side-slip-deg", true);
+  user_speed_node     = fgGetNode("/velocities/uBody-fps", true);
+
+
+  /// Move that into the constructor
+  for(int i = 0 ; i < root->nChildren() ; i++) {
+    SGPropertyNode *aiEntry = root->getChild( i );
+    if( !strcmp( aiEntry->getName(), "scenario" ) ) {
+      scenario_filename = aiEntry->getStringValue();
+      if (!scenario_filename.empty())
+        processScenario( scenario_filename );
     }
   }
+}
 
-  //**********  Flight Plan test code !!!! ****************
-  processScenario( "default_scenario" );
-  //******************************************************* 
 
-  initDone = true;
+void FGAIManager::reinit() {
+   update(0.0);
 }
 
 
 void FGAIManager::bind() {
    root = globals->get_props()->getNode("ai/models", true);
-   root->tie("count", SGRawValuePointer<int>(&numObjects));
+   root->tie("count", SGRawValueMethods<FGAIManager, int>(*this,
+             &FGAIManager::getNumAiObjects));
 }
 
 
@@ -133,230 +99,82 @@ void FGAIManager::unbind() {
 
 
 void FGAIManager::update(double dt) {
+  // initialize these for finding nearest thermals
+  range_nearest = 10000.0;
+  strength = 0.0;
+  if (!enabled)
+    return;
 
-        // initialize these for finding nearest thermals
-        range_nearest = 10000.0;
-        strength = 0.0;
-
-        _dt = dt;      
-
-        ai_list_itr = ai_list.begin();
-        while(ai_list_itr != ai_list.end()) {
-                if ((*ai_list_itr)->getDie()) {      
-                   freeID((*ai_list_itr)->getID());
-                   delete (*ai_list_itr);
-                   ai_list.erase(ai_list_itr);
-                   --ai_list_itr;
-                   --numObjects;
-                } else {
-                   fetchUserState();
-                   if ((*ai_list_itr)->isa(FGAIBase::otThermal)) {
-                       processThermal((FGAIThermal*)*ai_list_itr); 
-                   } else { 
-                      (*ai_list_itr)->update(_dt);
-                   }
-                }
-                ++ai_list_itr;
-        }
-        wind_from_down->setDoubleValue( strength );
-}
-
-
-// This function returns the next available ID
-int FGAIManager::assignID() {
-  int maxint = 30000;
-  int x; 
-  bool used;
-  for (x=0; x<maxint; x++) {
-     used = false;
-     id_itr = ids.begin();
-     while( id_itr != ids.end() ) {
-       if ((*id_itr) == x) used = true;
-       ++id_itr;
-     }
-     if (!used) {
-       ids.push_back(x);
-       return x;
-     } 
-  }
-  return -1;  // no available ID's
-}
-
+  FGTrafficManager *tmgr = (FGTrafficManager*) globals->get_subsystem("Traffic Manager");
+  _dt = dt;
 
-// This function removes an ID from the ID array, making it
-// available for assignment to another AI object
-void FGAIManager::freeID( int ID ) {
-    id_itr = ids.begin();
-    while( id_itr != ids.end() ) {
-      if (*id_itr == ID) {
-        ids.erase( id_itr );
-        return;
+  ai_list_iterator ai_list_itr = ai_list.begin();
+  while(ai_list_itr != ai_list.end()) {
+    if ((*ai_list_itr)->getDie()) {      
+      tmgr->release((*ai_list_itr)->getID());
+      --mNumAiModels;
+      --(mNumAiTypeModels[(*ai_list_itr)->getType()]);
+      (*ai_list_itr)->unbind();
+      ai_list_itr = ai_list.erase(ai_list_itr);
+    } else {
+      fetchUserState();
+      if ((*ai_list_itr)->isa(FGAIBase::otThermal)) {
+        FGAIBase *base = *ai_list_itr;
+        processThermal((FGAIThermal*)base); 
+      } else { 
+        (*ai_list_itr)->update(_dt);
       }
-      ++id_itr;
-    }  
-}
-
-int FGAIManager::createAircraft( string model_class, string path,
-              double latitude, double longitude, double altitude,
-              double heading, double speed, double pitch, double roll ) {
-     
-        FGAIAircraft* ai_plane = new FGAIAircraft(this);
-        ai_list.push_back(ai_plane);
-        ai_plane->setID( assignID() );
-        ++numObjects;
-        if (model_class == "light") {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::LIGHT]);
-        } else if (model_class == "ww2_fighter") {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::WW2_FIGHTER]);
-        } else if (model_class ==  "jet_transport") {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::JET_TRANSPORT]);
-        } else if (model_class == "jet_fighter") {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::JET_FIGHTER]);
-        } else {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::JET_TRANSPORT]);
-        }
-        ai_plane->setHeading(heading);
-        ai_plane->setSpeed(speed);
-        ai_plane->setPath(path.c_str());
-        ai_plane->setAltitude(altitude);
-        ai_plane->setLongitude(longitude);
-        ai_plane->setLatitude(latitude);
-        ai_plane->setBank(roll);
-        ai_plane->init();
-        ai_plane->bind();
-        return ai_plane->getID();
-}
-
-
-int FGAIManager::createAircraft( string model_class, string path,
-              FGAIFlightPlan* flightplan ) {
-     
-        FGAIAircraft* ai_plane = new FGAIAircraft(this);
-        ai_list.push_back(ai_plane);
-        ai_plane->setID( assignID() );
-        ++numObjects;
-        if (model_class == "light") {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::LIGHT]);
-        } else if (model_class == "ww2_fighter") {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::WW2_FIGHTER]);
-        } else if (model_class ==  "jet_transport") {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::JET_TRANSPORT]);
-        } else if (model_class == "jet_fighter") {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::JET_FIGHTER]);
-        } else {
-          ai_plane->SetPerformance(&FGAIAircraft::settings[FGAIAircraft::JET_TRANSPORT]);
-        }
-        ai_plane->setPath(path.c_str());
-        ai_plane->SetFlightPlan(flightplan);
-        ai_plane->init();
-        ai_plane->bind();
-        return ai_plane->getID();
-}
-
-
-int FGAIManager::createShip( string path, double latitude, double longitude,
-                             double altitude, double heading, double speed,
-                             double rudder ) {
-
-        FGAIShip* ai_ship = new FGAIShip(this);
-        ai_list.push_back(ai_ship);
-        ai_ship->setID( assignID() );
-        ++numObjects;
-        ai_ship->setHeading(heading);
-        ai_ship->setSpeed(speed);
-        ai_ship->setPath(path.c_str());
-        ai_ship->setAltitude(altitude);
-        ai_ship->setLongitude(longitude);
-        ai_ship->setLatitude(latitude);
-        ai_ship->setBank(rudder);
-        ai_ship->init();
-        ai_ship->bind();
-        return ai_ship->getID();
+      ++ai_list_itr;
+    }
+  }
+  wind_from_down_node->setDoubleValue( strength ); // for thermals
 }
 
-
-int FGAIManager::createBallistic( string path, double latitude, double longitude,
-                                  double altitude, double azimuth, double elevation,
-                                  double speed ) {
-
-        FGAIBallistic* ai_ballistic = new FGAIBallistic(this);
-        ai_list.push_back(ai_ballistic);
-        ai_ballistic->setID( assignID() );    
-        ++numObjects;
-        ai_ballistic->setAzimuth(azimuth);
-        ai_ballistic->setElevation(elevation);
-        ai_ballistic->setSpeed(speed);
-        ai_ballistic->setPath(path.c_str());
-        ai_ballistic->setAltitude(altitude);
-        ai_ballistic->setLongitude(longitude);
-        ai_ballistic->setLatitude(latitude);
-        ai_ballistic->init();
-        ai_ballistic->bind();
-        return ai_ballistic->getID();
+void
+FGAIManager::attach(SGSharedPtr<FGAIBase> model)
+{
+  unsigned idx = mNumAiTypeModels[model->getType()];
+  const char* typeString = model->getTypeString();
+  SGPropertyNode* root = globals->get_props()->getNode("ai/models", true);
+  SGPropertyNode* p = root->getNode(typeString, idx, true);
+  model->setManager(this, p);
+  ai_list.push_back(model);
+  ++mNumAiModels;
+  ++(mNumAiTypeModels[model->getType()]);
+  model->init();
+  model->bind();
 }
 
-int FGAIManager::createStorm( string path, double latitude, double longitude,
-                             double altitude, double heading, double speed ) {
-
-        FGAIStorm* ai_storm = new FGAIStorm(this);
-        ai_list.push_back(ai_storm);
-        ai_storm->setID( assignID() );
-        ++numObjects;
-        ai_storm->setHeading(heading);
-        ai_storm->setSpeed(speed);
-        ai_storm->setPath(path.c_str());
-        ai_storm->setAltitude(altitude);
-        ai_storm->setLongitude(longitude);
-        ai_storm->setLatitude(latitude);
-        ai_storm->init();
-        ai_storm->bind();
-        return ai_storm->getID();
-}
 
-int FGAIManager::createThermal( double latitude, double longitude,
-                                double strength, double diameter ) {
-
-        FGAIThermal* ai_thermal = new FGAIThermal(this);
-        ai_list.push_back(ai_thermal);
-        ai_thermal->setID( assignID() );
-        ++numObjects;
-        ai_thermal->setLongitude(longitude);
-        ai_thermal->setLatitude(latitude);
-        ai_thermal->setMaxStrength(strength);
-        ai_thermal->setDiameter(diameter / 6076.11549);
-        ai_thermal->init();
-        ai_thermal->bind();
-        return ai_thermal->getID();
+void FGAIManager::destroyObject( int ID ) {
+  ai_list_iterator ai_list_itr = ai_list.begin();
+  while(ai_list_itr != ai_list.end()) {
+    if ((*ai_list_itr)->getID() == ID) {
+      --mNumAiModels;
+      --(mNumAiTypeModels[(*ai_list_itr)->getType()]);
+      (*ai_list_itr)->unbind();
+      ai_list_itr = ai_list.erase(ai_list_itr);
+    } else
+      ++ai_list_itr;
+  }
 }
 
-void FGAIManager::destroyObject( int ID ) {
-        ai_list_itr = ai_list.begin();
-        while(ai_list_itr != ai_list.end()) {
-            if ((*ai_list_itr)->getID() == ID) {
-              freeID( ID );
-              delete (*ai_list_itr);
-              ai_list.erase(ai_list_itr);
-              --ai_list_itr;
-              --numObjects;
-              return;
-            }
-            ++ai_list_itr;
-        }
+int
+FGAIManager::getNumAiObjects(void) const
+{
+  return mNumAiModels;
 }
 
-// fetch the user's state every 10 sim cycles
 void FGAIManager::fetchUserState( void ) {
-   ++dt_count;
-   if (dt_count == 10) {
-     user_latitude  = fgGetDouble("/position/latitude-deg");
-     user_longitude = fgGetDouble("/position/longitude-deg");
-     user_altitude  = fgGetDouble("/position/altitude-ft");
-     user_heading   = fgGetDouble("/orientation/heading-deg");
-     user_pitch     = fgGetDouble("/orientation/pitch-deg");
-     user_yaw       = fgGetDouble("/orientation/side-slip-deg");
-     user_speed     = fgGetDouble("/velocities/uBody-fps") * 0.592484;
-     dt_count = 0;
-   }
+     user_latitude  = user_latitude_node->getDoubleValue();
+     user_longitude = user_longitude_node->getDoubleValue();
+     user_altitude  = user_altitude_node->getDoubleValue();
+     user_heading   = user_heading_node->getDoubleValue();
+     user_pitch     = user_pitch_node->getDoubleValue();
+     user_yaw       = user_yaw_node->getDoubleValue();
+     user_speed     = user_speed_node->getDoubleValue() * 0.592484;
+     wind_from_east = wind_from_east_node->getDoubleValue();
+     wind_from_north = wind_from_north_node->getDoubleValue();
 }
 
 
@@ -370,14 +188,130 @@ void FGAIManager::processThermal( FGAIThermal* thermal ) {
 }
 
 
-void FGAIManager::processScenario( string filename ) {
-  //cout << "AIManager: creating a scenario." << endl;
-  FGAIScenario* s = new FGAIScenario( filename );
-  FGAIScenario::entry* en = s->getNextEntry();
-  if (en) {
-    FGAIFlightPlan* f = new FGAIFlightPlan( en->flightplan );
-    createAircraft("jet_transport", "Aircraft/737/Models/boeing733.xml", f);
+void FGAIManager::processScenario( const string &filename ) {
+
+  SGPropertyNode_ptr scenarioTop = loadScenarioFile(filename);
+  if (!scenarioTop)
+    return;
+  SGPropertyNode* scenarios = scenarioTop->getChild("scenario");
+  if (!scenarios)
+    return;
+
+  for (int i = 0; i < scenarios->nChildren(); i++) { 
+    SGPropertyNode* scEntry = scenarios->getChild(i);
+    std::string type = scEntry->getStringValue("type", "aircraft");
+
+    if (type == "aircraft") {
+      FGAIAircraft* aircraft = new FGAIAircraft;
+      aircraft->readFromScenario(scEntry);
+      attach(aircraft);
+
+    } else if (type == "ship") {
+      FGAIShip* ship = new FGAIShip;
+      ship->readFromScenario(scEntry);
+      attach(ship);
+      
+    } else if (type == "carrier") {
+      FGAICarrier* carrier = new FGAICarrier;
+      carrier->readFromScenario(scEntry);
+      attach(carrier);
+      
+    } else if (type == "thunderstorm") {
+      FGAIStorm* storm = new FGAIStorm;
+      storm->readFromScenario(scEntry);
+      attach(storm);
+      
+    } else if (type == "thermal") {
+      FGAIThermal* thermal = new FGAIThermal;
+      thermal->readFromScenario(scEntry);
+      attach(thermal);
+      
+    } else if (type == "ballistic") {
+      FGAIBallistic* ballistic = new FGAIBallistic;
+      ballistic->readFromScenario(scEntry);
+      attach(ballistic);
+      
+    } else if (type == "static") {
+      FGAIStatic* aistatic = new FGAIStatic;
+      aistatic->readFromScenario(scEntry);
+      attach(aistatic);
+      
+    }
+  }
+}
+
+SGPropertyNode_ptr
+FGAIManager::loadScenarioFile(const std::string& filename)
+{
+  SGPath path(globals->get_fg_root());
+  path.append("AI/" + filename + ".xml");
+  try {
+    SGPropertyNode_ptr root = new SGPropertyNode;
+    readProperties(path.str(), root);
+    return root;
+  } catch (const sg_exception &e) {
+    SG_LOG(SG_GENERAL, SG_ALERT, "Incorrect path specified for AI "
+           "scenario: \"" << path.str() << "\"");
+    return 0;
+  }
+}
+
+// This code keeps track of models that have already been loaded
+// Eventually we'd prbably need to find a way to keep track of models
+// that are unloaded again
+ssgBranch * FGAIManager::getModel(const string& path) const
+{
+  ModelVecIterator i = loadedModels.begin();
+  while (i != loadedModels.end())
+    {
+      if (i->getPath() == path)
+       return i->getModelId();
+      i++;
+    }
+  return 0;
+}
+
+void FGAIManager::setModel(const string& path, ssgBranch *model)
+{
+  loadedModels.push_back(FGModelID(path,model));
+}
+
+bool FGAIManager::getStartPosition(const string& id, const string& pid,
+                                   SGGeod& geodPos, double& hdng, SGVec3d& uvw)
+{
+  bool found = false;
+  SGPropertyNode* root = fgGetNode("sim/ai", true);
+  if (!root->getNode("enabled", true)->getBoolValue())
+      return found;
+
+  for(int i = 0 ; (!found) && i < root->nChildren() ; i++) {
+    SGPropertyNode *aiEntry = root->getChild( i );
+    if( !strcmp( aiEntry->getName(), "scenario" ) ) {
+      string filename = aiEntry->getStringValue();
+      SGPropertyNode_ptr scenarioTop = loadScenarioFile(filename);
+      if (scenarioTop) {
+        SGPropertyNode* scenarios = scenarioTop->getChild("scenario");
+        if (scenarios) {
+          for (int i = 0; i < scenarios->nChildren(); i++) { 
+            SGPropertyNode* scEntry = scenarios->getChild(i);
+            std::string type = scEntry->getStringValue("type");
+            std::string pnumber = scEntry->getStringValue("pennant-number");
+            std::string name = scEntry->getStringValue("name");
+            if (type == "carrier" && (pnumber == id || name == id)) {
+              SGSharedPtr<FGAICarrier> carrier = new FGAICarrier;
+              carrier->readFromScenario(scEntry);
+              
+              if (carrier->getParkPosition(pid, geodPos, hdng, uvw)) {
+                found = true;
+                break;
+              }
+            }
+          }
+        }
+      }
+    }
   }
-  delete s;
+  return found;
 }
 
+//end AIManager.cxx