~jtaylor/ubuntu/oneiric/flightgear/fix-749249

 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

 *

 * This is the top-level function, and the only one that publicly available.

void FGAIFlightPlan::create(FGAirport *dep, FGAirport *arr, int legNr, double alt, double speed, 

                            double latitude, double longitude, bool firstFlight,

                            double radius, const string& fltType, const string& aircraftType, const string& airline)

      //cerr << "Creating Push_Back" << endl;

      createPushBack(firstFlight,dep, latitude, longitude, radius, fltType, aircraftType, airline);

      //cerr << "Done" << endl;

      //cerr << "Creating Taxi" << endl;

      createTaxi(firstFlight, 1, dep, latitude, longitude, radius, fltType, aircraftType, airline);

      //cerr << "Creating TAkeoff" << endl;

      //cerr << "Creating Climb" << endl;

      //cerr << "Creating Cruise" << endl;

      //cerr << "Creating Decent" << endl;

      //cerr << "Creating Landing" << endl;

      //cerr << "Creating Taxi 2" << endl;

      createTaxi(false, 2, arr, latitude, longitude, radius, fltType, aircraftType, airline);

    case 9: 

      //cerr << "Creating Parking" << endl;

      createParking(arr);

      cerr << "Unknown case: " << legNr << endl;

                                    double latitude,

                                    double longitude,

                                    double radius,

                                    const string& fltType,

                                    const string& aircraftType,

                                    const string& airline)

      if (!(dep->getAvailableParking(&lat, &lon, &heading, &gateId, radius, fltType, aircraftType, airline)))

        {

          cerr << "Could not find parking " << endl;

        }

      dep->getParking(gateId, &lat, &lon, &heading);

      //lat     = latitude;

      //lon     = longitude;

      //heading = getHeading();

                      10, 

                      &lat2, &lon2, &az2 );

                      radius,                 // push back one entire aircraft radius

                      &lat2, &lon2, &az2 );

  waypoints.push_back(wpt); 

 

  

void FGAIFlightPlan::createTaxi(bool firstFlight, int direction, FGAirport *apt, double latitude, double longitude, double radius, const string& fltType, const string& acType, const string& airline)

  //FGRunway rwy;

  //int direction;

  // Erase all existing waypoints.

  //   wpt_vector_iterator i= waypoints.begin();

  //resetWaypoints();

  //int currWpt = wpt_iterator - waypoints.begin();

  if (direction == 1)

      //string name;

      apt->getActiveRunway("com", 1, activeRunway);

          cout << "Failed to find runway for " << apt->getId() << endl;

          // Hmm, how do we handle a potential error like this?

          exit(1);

        }

      //string test;

      //apt->getActiveRunway(string("com"), 1, test);

      //exit(1);

      

      if (apt->getGroundNetwork()->exists())

          int runwayId = apt->getGroundNetwork()->findNearestNode(lat2, lon2);

          //int currId   = apt->getGroundNetwork()->findNearestNode(latitude,longitude);

          //exit(1);

          // Starting from gate 0 is a bit of a hack...

            route = apt->getGroundNetwork()->findShortestRoute(gateId, runwayId);

            route = apt->getGroundNetwork()->findShortestRoute(0, runwayId);

          //cerr << "creating route : ";

          // No route found: go from gate directly to runway

                //i = ids.end()-1;

                //cerr << "Creating Node: " << node << endl;

                FGTaxiNode *tn = apt->getGroundNetwork()->findNode(node);

                wpt->altitude  = apt->getElevation(); // should maybe be tn->elev too

                wpt->speed     = 15; 

          //exit(1);

          //wpt = new waypoint;

          //wpt->finished = false;

          //waypoints.push_back(wpt);  // add one more to prevent a segfault. 

      //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->getActiveRunway("com", 1, name);

      //if (!(globals->get_runways()->search(apt->getId(), 

      //                                    name, 

      //                            &rwy)))

      //{//

      //cout << "Failed to find runway for " << apt->getId() << endl;

      // Hmm, how do we handle a potential error like this?

      // exit(1);

      //        }

      //string test;

      //apt->getActiveRunway(string("com"), 1, test);

      //exit(1);

      

      //heading = rwy._heading;

      //double azimuth = heading + 180.0;

      //while ( azimuth >= 360.0 ) { azimuth -= 360.0; }

      //geo_direct_wgs_84 ( 0, rwy._lat, rwy._lon, azimuth, 

      //                  rwy._length * SG_FEET_TO_METER * 0.5 - 5.0,

      //                  &lat2, &lon2, &az2 );

      apt->getAvailableParking(&lat, &lon, &heading, &gateId, radius, fltType, acType, airline);

      heading += 180.0;

      if (heading > 360)

        heading -= 360;

      geo_direct_wgs_84 ( 0, lat, lon, heading, 

                          100,

                          &lat2, &lon2, &az2 );

      cerr << (*(waypoints.end()-1))->name << endl;

      if (apt->getGroundNetwork()->exists())

          int runwayId = apt->getGroundNetwork()->findNearestNode(lat3, lon3);

          //int currId   = apt->getGroundNetwork()->findNearestNode(latitude,longitude);

          //exit(1);

          

            route = apt->getGroundNetwork()->findShortestRoute(runwayId, gateId);

            route = apt->getGroundNetwork()->findShortestRoute(runwayId, 0);

          //cerr << "creating route : ";

            while(route.next(&node))

                //i = ids.end()-1;

                //cerr << "Creating Node: " << node << endl;

                FGTaxiNode *tn = apt->getGroundNetwork()->findNode(node);

                //ids.pop_back();  

                wpt->altitude  = apt->getElevation(); // should maybe be tn->elev too

            cerr << endl;

          //exit(1);

          //Add the runway startpoint;

 

 

 

 

      // Add the final destination waypoint

      wpt = new waypoint;

      wpt->name      = "Begin Parking"; //apt->getId(); //wpt_node->getStringValue("name", "END");

      wpt->latitude  = lat2;

      wpt->longitude = lon2;

      wpt->altitude  = apt->getElevation();

      wpt->speed     = 15; 

      wpt->crossat   = -10000;

      wpt->gear_down = true;

      wpt->flaps_down= true;

      wpt->finished  = false;

      wpt->on_ground = true;

      waypoints.push_back(wpt); 

 

     

  // wpt_iterator = waypoints.begin();

  //if (!firstFlight)

  // wpt_iterator++; 

  //wpt_iterator = waypoints.begin()+currWpt;

  //FGRunway rwy;

  //int direction;

  

  // Erase all existing waypoints.

  // wpt_vector_iterator i= waypoints.begin();

  //while(waypoints.begin() != waypoints.end())

  //  {      

  //    delete *(i);

  //    waypoints.erase(i);

  //  }

  //resetWaypoints();

  

  

      apt->getActiveRunway("com", 1, activeRunway);

            cout << "Failed to find runway for " << apt->getId() << endl;

            // Hmm, how do we handle a potential error like this?

        //string test;

      //apt->getActiveRunway(string("com"), 1, test);

      //exit(1);

  

  //  waypoints.push_back(wpt);

  //waypoints.push_back(wpt);  // add one more to prevent a segfault. 

  // wpt_iterator = waypoints.begin();

  //if (!firstFlight)

  // wpt_iterator++;

  // Erase all existing waypoints.

  // wpt_vector_iterator i= waypoints.begin();

  //while(waypoints.begin() != waypoints.end())

  //  {      

  //    delete *(i);

  //    waypoints.erase(i);

  //  }

  //resetWaypoints();

  

  

  // Get the current active runway, based on code from David Luff

  // This should actually be unified and extended to include 

  // Preferential runway use schema's 

      apt->getActiveRunway("com", 1, activeRunway);

            cout << "Failed to find runway for " << apt->getId() << endl;

            // Hmm, how do we handle a potential error like this?

        //string test;

        //apt->getActiveRunway(string("com"), 1, test);

      //exit(1);

  //waypoints.push_back(wpt); 

  //waypoints.push_back(wpt);  // add one more to prevent a segfault. 

  // wpt_iterator = waypoints.begin();

  //if (!firstFlight)

  // wpt_iterator++;

void FGAIFlightPlan::createCruise(bool firstFlight, FGAirport *dep, FGAirport *arr, double latitude, double longitude, double speed, double alt)

  //FGRunway rwy;

  //int direction;

  // Erase all existing waypoints.

  // wpt_vector_iterator i= waypoints.begin();

  //while(waypoints.begin() != waypoints.end())

  //  {      

  //    delete *(i);

  //    waypoints.erase(i);

  //  }

  //resetWaypoints();

 

  //Beginning of Decent

  //string name;

  arr->getActiveRunway("com", 2, activeRunway);

      cout << "Failed to find runway for " << arr->getId() << endl;

      // Hmm, how do we handle a potential error like this?

  //string test;

  //arr->getActiveRunway(string("com"), 1, test);

  //exit(1);

  

  //cerr << "Altitude = " << alt << endl;

  //cerr << "Done" << endl;

  //if (arr->getId() == "EHAM")

  //  {

  //    cerr << "Creating cruise to EHAM " << latitude << " " << longitude << endl;

  //  }

  // Note: This places us at the location of the active 

  // runway during initial cruise. This needs to be 

  // fixed later. 

  wpt->name      = "BOD"; //wpt_node->getStringValue("name", "END");

  //waypoints.push_back(wpt);

  //waypoints.push_back(wpt);  // add one more to prevent a segfault.  

  //wpt_iterator = waypoints.begin();

  //if (!firstFlight)

  // wpt_iterator++;

  //// Erase all existing waypoints.

  // wpt_vector_iterator i= waypoints.begin();

  //while(waypoints.begin() != waypoints.end())

  //  {      

  //    delete *(i);

  //    waypoints.erase(i);

  //  }

  //resetWaypoints();

 

  apt->getActiveRunway("com", 2, activeRunway);

    if (!(globals->get_runways()->search(apt->getId(), 

                                          activeRunway, 

                                          &rwy)))

      {

        cout << "Failed to find runway for " << apt->getId() << endl;

        // Hmm, how do we handle a potential error like this?

        exit(1);

      }

    //string test;

    //apt->getActiveRunway(string("com"), 1, test);

  //exit(1);

 

  //cerr << "Done" << endl;

  

  

  

 

                     8*SG_NM_TO_METER,

                     &lat2, &lon2, &az2 );

  //waypoints.push_back(wpt);

  //waypoints.push_back(wpt);  // add one more to prevent a segfault. 

  //wpt_iterator = waypoints.begin();

  //wpt_iterator++;

  //if (apt->getId() == "EHAM")

  //  {

  //    cerr << "Created Decend to EHAM " << lat2 << " " << lon2 << ": Runway = " << rwy._rwy_no 

  //       << "heading " << heading << endl;

  //  }

  // Ten thousand ft. Slowing down to 240 kts

  //waypoints.push_back(wpt); 

  //waypoints.push_back(wpt);  // add one more to prevent a segfault. 

  //wpt_iterator = waypoints.begin();

  //wpt_iterator++;

 

  //if (apt->getId() == "EHAM")

  //{

  //  cerr << "Created Landing to EHAM " << lat2 << " " << lon2 << ": Runway = " << rwy._rwy_no 

  //     << "heading " << heading << endl;

  //}

void FGAIFlightPlan::createParking(FGAirport *apt)

  double lat;

  double lon;

  apt->getParking(gateId, &lat, &lon, &heading);

  // Erase all existing waypoints.

  // wpt_vector_iterator i= waypoints.begin();

  //while(waypoints.begin() != waypoints.end())

  //  {      

  //    delete *(i);

  //    waypoints.erase(i);

  //  }

  //resetWaypoints();

  // And finally one more named "END"

  wpt->altitude  = 19;

  //waypoints.push_back(wpt);

  //waypoints.push_back(wpt);  // add one more to prevent a segfault. 

  //wpt_iterator = waypoints.begin();

  //wpt_iterator++;