1 /******************************************************************************
3 * Written by Durk Talsma, started May 5, 2004.
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.
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.
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.
20 **************************************************************************/
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.
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
31 * 4) Each aircraft leaves at exactly the departure time.
32 * 5) Each aircraft arrives at exactly the specified arrival time.
35 *****************************************************************************/
54 #include <simgear/compiler.h>
55 #include <simgear/math/polar3d.hxx>
56 #include <simgear/math/sg_geodesy.hxx>
57 #include <simgear/misc/sg_path.hxx>
58 #include <simgear/props/props.hxx>
59 #include <simgear/route/waypoint.hxx>
60 #include <simgear/structure/subsystem_mgr.hxx>
61 #include <simgear/xml/easyxml.hxx>
63 #include <AIModel/AIAircraft.hxx>
64 #include <AIModel/AIFlightPlan.hxx>
65 #include <AIModel/AIBase.hxx>
66 #include <Airports/simple.hxx>
67 #include <Main/fg_init.hxx>
71 #include "TrafficMgr.hxx"
75 /******************************************************************************
77 *****************************************************************************/
78 FGTrafficManager::FGTrafficManager()
84 FGTrafficManager:: ~FGTrafficManager()
86 for (ScheduleVectorIterator sched = scheduledAircraft.begin(); sched != scheduledAircraft.end(); sched++)
90 scheduledAircraft.clear();
91 // for (FGScheduledFlightVecIterator flt = flights.begin(); flt != flights.end(); flt++)
99 void FGTrafficManager::init()
101 //cerr << "Initializing Schedules" << endl;
102 //time_t now = time(NULL) + fgGetLong("/sim/time/warp");
103 //currAircraft = scheduledAircraft.begin();
104 //while (currAircraft != scheduledAircraft.end())
106 // if (!(currAircraft->init()))
108 // currAircraft=scheduledAircraft.erase(currAircraft);
109 // //cerr << "Erasing " << currAircraft->getRegistration() << endl;
116 // Sort by points: Aircraft with frequent visits to the
117 // startup airport will be processed first
119 ulDirEnt* dent, *dent2;
120 SGPath aircraftDir = globals->get_fg_root();
122 /* keep the following three lines (which mimicks the old "fixed path" behavior)
123 * until we have some AI models with traffic in the base package
125 SGPath path = aircraftDir;
126 path.append("Traffic/fgtraffic.xml");
128 readXML(path.str(),*this);
130 aircraftDir.append("AI/Aircraft");
131 if (aircraftDir.exists())
133 if((d = ulOpenDir(aircraftDir.c_str())) == NULL)
135 while((dent = ulReadDir(d)) != NULL) {
136 //cerr << "Scanning : " << dent->d_name << endl;
137 if (string(dent->d_name) != string(".") &&
138 string(dent->d_name) != string("..") &&
141 SGPath currACDir = aircraftDir;
142 currACDir.append(dent->d_name);
143 if ((d2 = ulOpenDir(currACDir.c_str())) == NULL)
145 while ((dent2 = ulReadDir(d2)) != NULL) {
146 SGPath currFile = currACDir;
147 currFile.append(dent2->d_name);
148 if (currFile.extension() == string("xml"))
150 //cerr << "found " << dent2->d_name << " for parsing" << endl;
151 SGPath currFile = currACDir;
152 currFile.append(dent2->d_name);
153 SG_LOG(SG_GENERAL, SG_INFO, "Scanning " << currFile.str() << " for traffic");
154 readXML(currFile.str(),*this);
162 // Sort by points: Aircraft with frequent visits to the
163 // startup airport will be processed first
164 sort(scheduledAircraft.begin(), scheduledAircraft.end(), compareSchedules);
165 currAircraft = scheduledAircraft.begin();
166 currAircraftClosest = scheduledAircraft.begin();
167 //cerr << "Done initializing schedules" << endl;
170 void FGTrafficManager::update(double /*dt*/)
172 //SG_LOG( SG_GENERAL, SG_INFO, "Running TrafficManager::Update() ");
173 // Hack alert: Skip running for the first frames 1000 after
174 // initialization to allow proper initialization of wheather stuff
175 // and runway assignments
182 time_t now = time(NULL) + fgGetLong("/sim/time/warp");
183 if (scheduledAircraft.size() == 0) {
184 //SG_LOG( SG_GENERAL, SG_INFO, "Returned Running TrafficManager::Update() ");
187 if(currAircraft == scheduledAircraft.end())
189 //cerr << "resetting schedule " << endl;
190 currAircraft = scheduledAircraft.begin();
192 if (!((*currAircraft)->update(now)))
194 // after proper initialization, we shouldnt get here.
195 // But let's make sure
196 SG_LOG( SG_GENERAL, SG_ALERT, "Failed to update aircraft schedule in traffic manager");
199 //SG_LOG( SG_GENERAL, SG_INFO, "Done Running TrafficManager::Update() ");
202 void FGTrafficManager::release(int id)
204 releaseList.push_back(id);
207 bool FGTrafficManager::isReleased(int id)
209 IdListIterator i = releaseList.begin();
210 while (i != releaseList.end())
214 releaseList.erase(i);
222 void FGTrafficManager::startXML () {
223 //cout << "Start XML" << endl;
226 void FGTrafficManager::endXML () {
227 //cout << "End XML" << endl;
230 void FGTrafficManager::startElement (const char * name, const XMLAttributes &atts) {
232 //cout << "Start element " << name << endl;
233 //FGTrafficManager temp;
234 //for (int i = 0; i < atts.size(); i++)
235 // if (string(atts.getName(i)) == string("include"))
236 attval = atts.getValue("include");
239 //cout << "including " << attval << endl;
241 globals->get_fg_root();
242 path.append("/Traffic/");
244 readXML(path.str(), *this);
246 // cout << " " << atts.getName(i) << '=' << atts.getValue(i) << endl;
249 void FGTrafficManager::endElement (const char * name) {
250 //cout << "End element " << name << endl;
251 string element(name);
252 if (element == string("model"))
254 else if (element == string("livery"))
256 else if (element == string("registration"))
257 registration = value;
258 else if (element == string("airline"))
260 else if (element == string("actype"))
262 else if (element == string("flighttype"))
264 else if (element == string("radius"))
265 radius = atoi(value.c_str());
266 else if (element == string("offset"))
267 offset = atoi(value.c_str());
268 else if (element == string("performance-class"))
270 else if (element == string("heavy"))
272 if(value == string("true"))
277 else if (element == string("callsign"))
279 else if (element == string("fltrules"))
281 else if (element == string("port"))
283 else if (element == string("time"))
285 else if (element == string("departure"))
287 departurePort = port;
288 departureTime = timeString;
290 else if (element == string("cruise-alt"))
291 cruiseAlt = atoi(value.c_str());
292 else if (element == string("arrival"))
295 arrivalTime = timeString;
297 else if (element == string("repeat"))
299 else if (element == string("flight"))
301 // We have loaded and parsed all the information belonging to this flight
302 // so we temporarily store it.
303 //cerr << "Pusing back flight " << callsign << endl;
304 //cerr << callsign << " " << fltrules << " "<< departurePort << " " << arrivalPort << " "
305 // << cruiseAlt << " " << departureTime<< " "<< arrivalTime << " " << repeat << endl;
307 //Prioritize aircraft
308 string apt = fgGetString("/sim/presets/airport-id");
309 //cerr << "Airport information: " << apt << " " << departurePort << " " << arrivalPort << endl;
310 if (departurePort == apt) score++;
311 flights.push_back(new FGScheduledFlight(callsign,
320 else if (element == string("aircraft"))
322 //cerr << "Pushing back aircraft " << registration << endl;
323 scheduledAircraft.push_back(new FGAISchedule(mdl,
335 // while(flights.begin() != flights.end()) {
336 // flights.pop_back();
338 for (FGScheduledFlightVecIterator flt = flights.begin(); flt != flights.end(); flt++)
343 SG_LOG( SG_GENERAL, SG_BULK, "Reading aircraft : "
345 << " with prioritization score "
351 void FGTrafficManager::data (const char * s, int len) {
352 string token = string(s,len);
353 //cout << "Character data " << string(s,len) << endl;
354 if ((token.find(" ") == string::npos && (token.find('\n')) == string::npos))
360 void FGTrafficManager::pi (const char * target, const char * data) {
361 //cout << "Processing instruction " << target << ' ' << data << endl;
364 void FGTrafficManager::warning (const char * message, int line, int column) {
365 SG_LOG(SG_IO, SG_WARN, "Warning: " << message << " (" << line << ',' << column << ')');
368 void FGTrafficManager::error (const char * message, int line, int column) {
369 SG_LOG(SG_IO, SG_ALERT, "Error: " << message << " (" << line << ',' << column << ')');