]> git.mxchange.org Git - flightgear.git/blobdiff - src/AIModel/AIFlightPlanCreate.cxx
model paging patch from Till Busch
[flightgear.git] / src / AIModel / AIFlightPlanCreate.cxx
index 01a43dcc6fbdeee9f6afd93e274002117f59d715..98da9247cc6f3ea53705d2ce4d25b7feece8cffa 100644 (file)
@@ -53,16 +53,16 @@ void FGAIFlightPlan::create(FGAirport *dep, FGAirport *arr, int legNr,
                 radius, fltType, aircraftType, airline);
       break;
     case 3: 
-      createTakeOff(firstFlight, dep, speed);
+      createTakeOff(firstFlight, dep, speed, fltType);
       break;
     case 4: 
-      createClimb(firstFlight, dep, speed, alt);
+      createClimb(firstFlight, dep, speed, alt, fltType);
       break;
     case 5: 
-      createCruise(firstFlight, dep,arr, latitude, longitude, speed, alt);
+      createCruise(firstFlight, dep,arr, latitude, longitude, speed, alt, fltType);
       break;
     case 6: 
-      createDecent(arr);
+      createDecent(arr, fltType);
       break;
     case 7: 
       createLanding(arr);
@@ -83,100 +83,10 @@ void FGAIFlightPlan::create(FGAirport *dep, FGAirport *arr, int legNr,
   leg++;
 }
 
-/*******************************************************************
- * createPushBack
- * initialize the Aircraft at the parking location
- ******************************************************************/
-void FGAIFlightPlan::createPushBack(bool firstFlight, FGAirport *dep, 
-                                   double latitude,
-                                   double longitude,
-                                   double radius,
-                                   const string& fltType,
-                                   const string& aircraftType,
-                                   const string& airline)
-{
-  double heading;
-  double lat;
-  double lon;
-  double lat2;
-  double lon2;
-  double az2;
-  
-  //int currWpt = wpt_iterator - waypoints.begin();
-  // Erase all existing waypoints.
-  //resetWaypoints();
-  
-  // We only need to get a valid parking if this is the first leg. 
-  // Otherwise use the current aircraft position.
-  if (firstFlight)
-    {
-      if (!(dep->getDynamics()->getAvailableParking(&lat, &lon, 
-                                                   &heading, &gateId, 
-                                                   radius, fltType, 
-                                                   aircraftType, airline)))
-       {
-         SG_LOG(SG_INPUT, SG_ALERT, "Could not find parking for a " << 
-                aircraftType <<
-                " of flight type " << fltType << 
-                " of airline     " << airline <<
-                " at airport     " << dep->getId());
-         //exit(1);
-       }
-    }
-  else
-    {
-      dep->getDynamics()->getParking(gateId, &lat, &lon, &heading);
-    }
-  heading += 180.0;
-  if (heading > 360)
-    heading -= 360;
-  waypoint *wpt = new waypoint;
-  wpt->name      = "park";
-  wpt->latitude  = lat;
-  wpt->longitude = lon;
-  wpt->altitude  = dep->getElevation();
-  wpt->speed     = -10; 
-  wpt->crossat   = -10000;
-  wpt->gear_down = true;
-  wpt->flaps_down= true;
-  wpt->finished  = false;
-  wpt->on_ground = true;
 
-  waypoints.push_back(wpt); 
-  
-  geo_direct_wgs_84 ( 0, lat, lon, heading, 
-                     10, 
-                     &lat2, &lon2, &az2 );
-  wpt = new waypoint;
-  wpt->name      = "park2";
-  wpt->latitude  = lat2;
-  wpt->longitude = lon2;
-  wpt->altitude  = dep->getElevation();
-  wpt->speed     = -10; 
-  wpt->crossat   = -10000;
-  wpt->gear_down = true;
-  wpt->flaps_down= true;
-  wpt->finished  = false;
-  wpt->on_ground = true;
-  wpt->routeIndex = 0;
-  waypoints.push_back(wpt); 
-  geo_direct_wgs_84 ( 0, lat, lon, heading, 
-                     2.2*radius,           
-                     &lat2, &lon2, &az2 );
-  wpt = new waypoint;
-  wpt->name      = "taxiStart";
-  wpt->latitude  = lat2;
-  wpt->longitude = lon2;
-  wpt->altitude  = dep->getElevation();
-  wpt->speed     = 10; 
-  wpt->crossat   = -10000;
-  wpt->gear_down = true;
-  wpt->flaps_down= true;
-  wpt->finished  = false;
-  wpt->on_ground = true;
-  wpt->routeIndex = 0;
-  waypoints.push_back(wpt);  
-}
+
+
+
 
 /*******************************************************************
  * createCreate Taxi. 
@@ -225,17 +135,15 @@ void FGAIFlightPlan::createTaxi(bool firstFlight, int direction,
          //wpt->on_ground = true;
          //waypoints.push_back(wpt);  
        }
-      // "NOTE: this is currently fixed to "com" for commercial traffic
-      // Should be changed to be used dynamically to allow "gen" and "mil"
-      // as well
-      apt->getDynamics()->getActiveRunway("com", 1, activeRunway);
+      string rwyClass = getRunwayClassFromTrafficType(fltType);
+      apt->getDynamics()->getActiveRunway(rwyClass, 1, activeRunway);
       if (!(globals->get_runways()->search(apt->getId(), 
                                            activeRunway, 
                                            &rwy)))
        {
           SG_LOG(SG_INPUT, SG_ALERT, "Failed to find runway " << 
                  activeRunway << 
-                 " at airport     " << apt->getId());
+                 " at airport     " << apt->getId() << " of class " << rwyClass << " (1)");
           exit(1);
        } 
 
@@ -259,14 +167,31 @@ void FGAIFlightPlan::createTaxi(bool firstFlight, int direction,
          // Starting from gate 0 in this case is a bit of a hack
          // which requires a more proper solution later on.
          //FGTaxiRoute route;
-         if (taxiRoute)
-           delete taxiRoute;
+         delete taxiRoute;
          taxiRoute = new FGTaxiRoute;
-         if (gateId >= 0)
-           *taxiRoute = apt->getDynamics()->getGroundNetwork()->findShortestRoute(gateId, 
-                                                                             runwayId);
-         else
-           *taxiRoute = apt->getDynamics()->getGroundNetwork()->findShortestRoute(0, runwayId);
+
+          // Determine which node to start from.
+          int node;
+          // Find out which node to start from
+          FGParking *park = apt->getDynamics()->getParking(gateId);
+          if (park)
+               node = park->getPushBackPoint();
+          else
+               node = 0;
+          if (node == -1)
+            node = gateId;
+
+          // HAndle case where parking doens't have a node
+          if ((node == 0) && park) {
+                if (firstFlight) {
+                    node = gateId;
+                } else {
+                   node = lastNodeVisited;
+                }
+          }
+
+          //cerr << "Using node " << node << endl;
+           *taxiRoute = apt->getDynamics()->getGroundNetwork()->findShortestRoute(node, runwayId);
          intVecIterator i;
         
          if (taxiRoute->empty()) {
@@ -302,30 +227,27 @@ void FGAIFlightPlan::createTaxi(bool firstFlight, int direction,
          } else {
            int node;
            taxiRoute->first();
-           bool isPushBackPoint = false;
+           //bool isPushBackPoint = false;
            if (firstFlight) {
+
              // If this is called during initialization, randomly
              // skip a number of waypoints to get a more realistic
              // taxi situation.
-             isPushBackPoint = true;
+             //isPushBackPoint = true;
              int nrWaypoints = taxiRoute->size();
              nrWaypointsToSkip = rand() % nrWaypoints;
              // but make sure we always keep two active waypoints
              // to prevent a segmentation fault
              for (int i = 0; i < nrWaypointsToSkip-2; i++) {
-               isPushBackPoint = false;
+               //isPushBackPoint = false;
                taxiRoute->next(&node);
              }
+             apt->getDynamics()->releaseParking(gateId);
            } else {
-             //chop off the first two waypoints, because
-             // those have already been created
-             // by create pushback
-             int size = taxiRoute->size();
-             if (size > 2) {
-               taxiRoute->next(&node);
-               taxiRoute->next(&node);
-             }
-           }
+               if (taxiRoute->size() > 1) {
+                   taxiRoute->next(&node); // chop off the first waypoint, because that is already the last of the pushback route
+               }
+            }
            int route;
            while(taxiRoute->next(&node, &route))
              {
@@ -341,13 +263,7 @@ void FGAIFlightPlan::createTaxi(bool firstFlight, int direction,
                // Elevation is currently disregarded when on_ground is true
                // because the AIModel obtains a periodic ground elevation estimate.
                wpt->altitude  = apt->getElevation();
-               if (isPushBackPoint) {
-                 wpt->speed = -10;
-                 isPushBackPoint = false;
-               }
-               else {
-                 wpt->speed     = 15; 
-               }
+               wpt->speed     = 15; 
                wpt->crossat   = -10000;
                wpt->gear_down = true;
                wpt->flaps_down= true;
@@ -356,6 +272,7 @@ void FGAIFlightPlan::createTaxi(bool firstFlight, int direction,
                wpt->routeIndex = route;
                waypoints.push_back(wpt);
              }
+             /*
            //cerr << endl;
            // finally, rewind the taxiRoute object to the point where we started
            // generating the Flightplan, for AI use.
@@ -372,7 +289,7 @@ void FGAIFlightPlan::createTaxi(bool firstFlight, int direction,
                //taxiRoute->next(&node);       
                //taxiRoute->next(&node);
              }
-           }
+           }*/
          } // taxiRoute not empty
        }
       else 
@@ -429,8 +346,7 @@ void FGAIFlightPlan::createTaxi(bool firstFlight, int direction,
          // fallback mechanism for this. 
          // Starting from gate 0 is a bit of a hack...
          //FGTaxiRoute route;
-         if (taxiRoute)
-           delete taxiRoute;
+         delete taxiRoute;
          taxiRoute = new FGTaxiRoute;
          if (gateId >= 0)
            *taxiRoute = apt->getDynamics()->getGroundNetwork()->findShortestRoute(runwayId, 
@@ -572,7 +488,7 @@ void FGAIFlightPlan::createTaxi(bool firstFlight, int direction,
  * CreateTakeOff 
  * initialize the Aircraft at the parking location
  ******************************************************************/
-void FGAIFlightPlan::createTakeOff(bool firstFlight, FGAirport *apt, double speed)
+void FGAIFlightPlan::createTakeOff(bool firstFlight, FGAirport *apt, double speed, const string &fltType)
 {
   double heading;
   double lat, lon, az;
@@ -585,17 +501,15 @@ void FGAIFlightPlan::createTakeOff(bool firstFlight, FGAirport *apt, double spee
   if (firstFlight)
     {
       //string name;
-       // "NOTE: this is currently fixed to "com" for commercial traffic
-      // Should be changed to be used dynamically to allow "gen" and "mil"
-      // as well
-      apt->getDynamics()->getActiveRunway("com", 1, activeRunway);
+      string rwyClass = getRunwayClassFromTrafficType(fltType);
+      apt->getDynamics()->getActiveRunway(rwyClass, 1, activeRunway);
        if (!(globals->get_runways()->search(apt->getId(), 
                                              activeRunway, 
                                              &rwy)))
          {
            SG_LOG(SG_INPUT, SG_ALERT, "Failed to find runway " << 
                   activeRunway << 
-                  " at airport     " << apt->getId());
+                  " at airport     " << apt->getId()<< " of class " << rwyClass << " (2)");
            exit(1);
          }
     }
@@ -709,7 +623,7 @@ void FGAIFlightPlan::createTakeOff(bool firstFlight, FGAirport *apt, double spee
  * CreateClimb
  * initialize the Aircraft at the parking location
  ******************************************************************/
-void FGAIFlightPlan::createClimb(bool firstFlight, FGAirport *apt, double speed, double alt)
+void FGAIFlightPlan::createClimb(bool firstFlight, FGAirport *apt, double speed, double alt, const string &fltType)
 {
   double heading;
   //FGRunway rwy;
@@ -721,17 +635,15 @@ void FGAIFlightPlan::createClimb(bool firstFlight, FGAirport *apt, double speed,
   if (firstFlight)
     {
       //string name;
-      // "NOTE: this is currently fixed to "com" for commercial traffic
-      // Should be changed to be used dynamically to allow "gen" and "mil"
-      // as well
-      apt->getDynamics()->getActiveRunway("com", 1, activeRunway);
+      string rwyClass = getRunwayClassFromTrafficType(fltType);
+      apt->getDynamics()->getActiveRunway(rwyClass, 1, activeRunway);
        if (!(globals->get_runways()->search(apt->getId(), 
                                              activeRunway, 
                                              &rwy)))
          {
            SG_LOG(SG_INPUT, SG_ALERT, "Failed to find runway " << 
                   activeRunway << 
-                  " at airport     " << apt->getId());
+                  " at airport     " << apt->getId()<< " of class " << rwyClass << " (3)");
            exit(1);
          }
     }
@@ -846,7 +758,7 @@ void FGAIFlightPlan::createClimb(bool firstFlight, FGAirport *apt, double speed,
  * CreateDecent
  * initialize the Aircraft at the parking location
  ******************************************************************/
-void FGAIFlightPlan::createDecent(FGAirport *apt)
+void FGAIFlightPlan::createDecent(FGAirport *apt, const string &fltType)
 {
 
   // Ten thousand ft. Slowing down to 240 kts
@@ -860,14 +772,15 @@ void FGAIFlightPlan::createDecent(FGAirport *apt)
   //Beginning of Decent
   //string name;
   // allow "mil" and "gen" as well
-  apt->getDynamics()->getActiveRunway("com", 2, activeRunway);
+  string rwyClass = getRunwayClassFromTrafficType(fltType);
+  apt->getDynamics()->getActiveRunway(rwyClass, 2, activeRunway);
   if (!(globals->get_runways()->search(apt->getId(), 
                                       activeRunway, 
                                       &rwy)))
     {
       SG_LOG(SG_INPUT, SG_ALERT, "Failed to find runway " << 
             activeRunway << 
-            " at airport     " << apt->getId());
+            " at airport     " << apt->getId()<< " of class " << rwyClass << " (4)");
       exit(1);
     }
   
@@ -1045,3 +958,43 @@ void FGAIFlightPlan::createParking(FGAirport *apt, double radius)
   wpt->routeIndex = 0;
   waypoints.push_back(wpt);
 }
+
+/**
+ *
+ * @param fltType a string describing the type of
+ * traffic, normally used for gate assignments
+ * @return a converted string that gives the runway
+ * preference schedule to be used at aircraft having
+ * a preferential runway schedule implemented (i.e.
+ * having a rwyprefs.xml file
+ * 
+ * Currently valid traffic types for gate assignment:
+ * - gate (commercial gate)
+ * - cargo (commercial gargo),
+ * - ga (general aviation) ,
+ * - ul (ultralight),
+ * - mil-fighter (military - fighter),
+ * - mil-transport (military - transport)
+ *
+ * Valid runway classes:
+ * - com (commercial traffic: jetliners, passenger and cargo)
+ * - gen (general aviation)
+ * - ul (ultralight: I can imagine that these may share a runway with ga on some airports)
+ * - mil (all military traffic)
+ */
+string FGAIFlightPlan::getRunwayClassFromTrafficType(string fltType)
+{
+    if ((fltType == "gate") || (fltType == "cargo")) { 
+       return string("com");
+    }
+    if (fltType == "ga") {
+        return string ("gen");
+    }
+    if (fltType == "ul") {
+        return string("ul");
+    }
+    if ((fltType == "mil-fighter") || (fltType == "mil-transport")) { 
+       return string("mil");
+    }
+   return string("com");
+}