src/Traffic/SchedFlight.cxx

   1 /******************************************************************************
   2  * SchedFlight.cxx
   3  * Written by Durk Talsma, started May 5, 2004.
   4  *
   5  * This program is free software; you can redistribute it and/or
   6  * modify it under the terms of the GNU General Public License as
   7  * published by the Free Software Foundation; either version 2 of the
   8  * License, or (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful, but
  11  * WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13  * General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
  18  *
  19  *
  20  **************************************************************************/
  21
  22 /* This a prototype version of a top-level flight plan manager for Flightgear.
  23  * It parses the fgtraffic.txt file and determine for a specific time/date,
  24  * where each aircraft listed in this file is at the current time.
  25  *
  26  * I'm currently assuming the following simplifications:
  27  * 1) The earth is a perfect sphere
  28  * 2) Each aircraft flies a perfect great circle route.
  29  * 3) Each aircraft flies at a constant speed (with infinite accelerations and
  30  *    decelerations)
  31  * 4) Each aircraft leaves at exactly the departure time.
  32  * 5) Each aircraft arrives at exactly the specified arrival time.
  33  *
  34  * TODO:
  35  * - Check the code for known portability issues
  36  * - Find an alternative for the depricated Point3D class
  37  *
  38  *****************************************************************************/
  39
  40 #ifdef HAVE_CONFIG_H
  41 #  include "config.h"
  42 #endif
  43
  44 #include <stdlib.h>
  45 #include <time.h>
  46 #include <iostream>
  47 #include <fstream>
  48
  49
  50 #include <string>
  51 #include <vector>
  52
  53 #include <plib/sg.h>
  54
  55 #include <simgear/compiler.h>
  56 #include <simgear/math/polar3d.hxx>
  57 #include <simgear/math/sg_geodesy.hxx>
  58 #include <simgear/props/props.hxx>
  59 #include <simgear/route/waypoint.hxx>
  60 #include <simgear/structure/subsystem_mgr.hxx>
  61 #include <simgear/timing/sg_time.hxx>
  62 #include <simgear/xml/easyxml.hxx>
  63
  64 #include <AIModel/AIFlightPlan.hxx>
  65 #include <AIModel/AIManager.hxx>
  66 #include <Airports/simple.hxx>
  67 #include <Main/fg_init.hxx>   // That's pretty ugly, but I need fgFindAirportID
  68
  69
  70
  71 #include <Main/globals.hxx>
  72
  73 #include "SchedFlight.hxx"
  74
  75
  76 /******************************************************************************
  77  * FGScheduledFlight stuff
  78  *****************************************************************************/
  79
  80 FGScheduledFlight::FGScheduledFlight()
  81 {
  82 }
  83
  84 FGScheduledFlight::FGScheduledFlight(const FGScheduledFlight &other)
  85 {
  86   callsign        = other.callsign;
  87   fltRules        = other.fltRules;
  88   departurePort   = other.departurePort;
  89   depId           = other.depId;
  90   arrId           = other.arrId;
  91   departureTime   = other.departureTime;
  92   cruiseAltitude  = other.cruiseAltitude;
  93   arrivalPort     = other.arrivalPort;
  94   arrivalTime     = other.arrivalTime;
  95   repeatPeriod    = other.repeatPeriod;
  96   initialized     = other.initialized;
  97 }
  98
  99 FGScheduledFlight::FGScheduledFlight(const string& cs,
 100                    const string& fr,
 101                    const string& depPrt,
 102                    const string& arrPrt,
 103                    int cruiseAlt,
 104                    const string& deptime,
 105                    const string& arrtime,
 106                    const string& rep)
 107 {
 108   callsign          = cs;
 109   fltRules          = fr;
 110   //departurePort.setId(depPrt);
 111   //arrivalPort.setId(arrPrt);
 112   depId = depPrt;
 113   arrId = arrPrt;
 114   //cerr << "Constructor: departure " << depId << ". arrival " << arrId << endl;
 115   //departureTime     = processTimeString(deptime);
 116   //arrivalTime       = processTimeString(arrtime);
 117   cruiseAltitude    = cruiseAlt;
 118
 119   // Process the repeat period string
 120   if (rep.find("WEEK",0) != string::npos)
 121     {
 122       repeatPeriod = 7*24*60*60; // in seconds
 123     }
 124   else if (rep.find("Hr", 0) != string::npos)
 125     {
 126       repeatPeriod = 60*60*atoi(rep.substr(0,2).c_str());
 127     }
 128   else
 129     {
 130       cerr << "Unknown repeat period" << endl;
 131       exit(1);
 132     }
 133
 134   // What we still need to do is preprocess the departure and
 135   // arrival times.
 136   departureTime = processTimeString(deptime);
 137   arrivalTime   = processTimeString(arrtime);
 138   if (departureTime > arrivalTime)
 139     {
 140       departureTime -= repeatPeriod;
 141     }
 142   initialized = false;
 143 }
 144
 145
 146 FGScheduledFlight:: ~FGScheduledFlight()
 147 {
 148 }
 149
 150 time_t FGScheduledFlight::processTimeString(const string& theTime)
 151 {
 152   int weekday;
 153   int timeOffsetInDays;
 154   int targetHour;
 155   int targetMinute;
 156   int targetSecond;
 157
 158   tm targetTimeDate;
 159   SGTime* currTimeDate = globals->get_time_params();
 160
 161   string timeCopy = theTime;
 162
 163
 164   // okay first split theTime string into
 165   // weekday, hour, minute, second;
 166   // Check if a week day is specified
 167   if (timeCopy.find("/",0) != string::npos)
 168     {
 169       weekday          = atoi(timeCopy.substr(0,1).c_str());
 170       timeOffsetInDays = weekday - currTimeDate->getGmt()->tm_wday;
 171       timeCopy = timeCopy.substr(2,timeCopy.length());
 172     }
 173   else
 174     {
 175       timeOffsetInDays = 0;
 176     }
 177   targetHour   = atoi(timeCopy.substr(0,2).c_str());
 178   targetMinute = atoi(timeCopy.substr(3,5).c_str());
 179   targetSecond = atoi(timeCopy.substr(6,8).c_str());
 180   targetTimeDate.tm_year  = currTimeDate->getGmt()->tm_year;
 181   targetTimeDate.tm_mon   = currTimeDate->getGmt()->tm_mon;
 182   targetTimeDate.tm_mday  = currTimeDate->getGmt()->tm_mday;
 183   targetTimeDate.tm_hour  = targetHour;
 184   targetTimeDate.tm_min   = targetMinute;
 185   targetTimeDate.tm_sec   = targetSecond;
 186
 187   time_t processedTime = sgTimeGetGMT(&targetTimeDate);
 188   processedTime += timeOffsetInDays*24*60*60;
 189   if (processedTime < currTimeDate->get_cur_time())
 190     {
 191       processedTime += repeatPeriod;
 192     }
 193   //tm *temp = currTimeDate->getGmt();
 194   //char buffer[512];
 195   //sgTimeFormatTime(&targetTimeDate, buffer);
 196   //cout << "Scheduled Time " << buffer << endl;
 197   //cout << "Time :" << time(NULL) << " SGTime : " << sgTimeGetGMT(temp) << endl;
 198   return processedTime;
 199 }
 200
 201 void FGScheduledFlight::update()
 202 {
 203   departureTime += repeatPeriod;
 204   arrivalTime  += repeatPeriod;
 205 }
 206
 207 void FGScheduledFlight::adjustTime(time_t now)
 208 {
 209   //cerr << "1: Adjusting schedule please wait: " << now
 210   //   << " " << arrivalTime << " " << arrivalTime+repeatPeriod << endl;
 211   // Make sure that the arrival time is in between
 212   // the current time and the next repeat period.
 213   while ((arrivalTime < now) || (arrivalTime > now+repeatPeriod))
 214     {
 215       if (arrivalTime < now)
 216         {
 217           departureTime += repeatPeriod;
 218           arrivalTime   += repeatPeriod;
 219         }
 220       else if (arrivalTime > now+repeatPeriod)
 221         {
 222           departureTime -= repeatPeriod;
 223           arrivalTime   -= repeatPeriod;
 224         }
 225       //      cerr << "2: Adjusting schedule please wait: " << now
 226       //   << " " << arrivalTime << " " << arrivalTime+repeatPeriod << endl;
 227     }
 228 }
 229
 230
 231 FGAirport *FGScheduledFlight::getDepartureAirport()
 232 {
 233   if (!(initialized))
 234     {
 235       initializeAirports();
 236     }
 237   if (initialized)
 238     return departurePort;
 239   else
 240     return 0;
 241 }
 242 FGAirport * FGScheduledFlight::getArrivalAirport  ()
 243 {
 244    if (!(initialized))
 245     {
 246       initializeAirports();
 247     }
 248    if (initialized)
 249      return arrivalPort;
 250    else
 251      return 0;
 252 }
 253
 254 // Upon the first time of requesting airport information
 255 // for this scheduled flight, these data need to be
 256 // looked up in the main FlightGear database.
 257 // Missing or bogus Airport codes are currently ignored,
 258 // but we should improve that. The best idea is probably to cancel
 259 // this flight entirely by removing it from the schedule, if one
 260 // of the airports cannot be found.
 261 bool FGScheduledFlight::initializeAirports()
 262 {
 263   //cerr << "Initializing using : " << depId << " " << arrId << endl;
 264   departurePort = globals->get_airports()->search(depId);
 265   if(departurePort == NULL)
 266     {
 267       cerr << "Could not find " << depId << endl;
 268       return false;
 269     }
 270   arrivalPort = globals->get_airports()->search(arrId);
 271   if(arrivalPort == NULL)
 272     {
 273       cerr << "Could not find " << arrId << endl;
 274       return false;
 275     }
 276
 277   //cerr << "Found : " << departurePort->getId() << endl;
 278   //cerr << "Found : " << arrivalPort->getId() << endl;
 279   initialized = true;
 280   return true;
 281 }