#include <simgear/compiler.h>
-#include <plib/sg.h>
#include <plib/ul.h>
#include <Environment/environment_mgr.hxx>
#include <Main/fg_props.hxx>
#include <Airports/runways.hxx>
-#include STL_STRING
+#include <string>
#include <vector>
-SG_USING_STD(string);
-SG_USING_STD(vector);
-SG_USING_STD(sort);
-SG_USING_STD(random_shuffle);
+using std::string;
+using std::vector;
+using std::sort;
+using std::random_shuffle;
#include "simple.hxx"
#include "dynamics.hxx"
FGAirportDynamics::FGAirportDynamics(FGAirport* ap) :
- _ap(ap), rwyPrefs(ap) {
+ _ap(ap), rwyPrefs(ap), SIDs(ap) {
lastUpdate = 0;
- for (int i = 0; i < 10; i++)
- {
- avWindHeading [i] = 0;
- avWindSpeed [i] = 0;
- }
+
+ // For testing only. This needs to be refined when we move ATIS functionality over.
+ atisInformation = "Sierra";
}
// Note that the ground network should also be copied
FGAirportDynamics::FGAirportDynamics(const FGAirportDynamics& other) :
- rwyPrefs(other.rwyPrefs)
+ rwyPrefs(other.rwyPrefs),
+ SIDs(other.SIDs)
{
for (FGParkingVecConstIterator ip= other.parkings.begin(); ip != other.parkings.end(); ip++)
parkings.push_back(*(ip));
for (il = other.takeoff.begin(); il != other.takeoff.end(); il++)
takeoff.push_back(*il);
lastUpdate = other.lastUpdate;
- for (int i = 0; i < 10; i++)
- {
- avWindHeading [i] = other.avWindHeading[i];
- avWindSpeed [i] = other.avWindSpeed [i];
- }
+ atisInformation = other.atisInformation;
}
// Destructor
if (!(i->getCodes().empty()))
{
if ((i->getCodes().find(airline,0) == string::npos))
- {
- available = false;
- continue;
- }
+ {
+ available = false;
+ continue;
+ }
}
if (i->getType() != flType)
{
i->setAvailable(false);
found = true;
}
- }
+ }
// And finally once more if that didn't work. Now ignore the airline codes, as a last resort
for (i = parkings.begin(); !(i == parkings.end() || found); i++)
{
}
}
-FGParking *FGAirportDynamics::getParking(int i)
+FGParking *FGAirportDynamics::getParking(int id)
{
- if (i < (int)parkings.size())
- return &(parkings[i]);
- else
+ FGParkingVecIterator i = parkings.begin();
+ for (i = parkings.begin(); i != parkings.end(); i++)
+ {
+ if (id == i->getIndex()) {
+ return &(*i);
+ }
+ }
return 0;
}
-string FGAirportDynamics::getParkingName(int i)
+string FGAirportDynamics::getParkingName(int id)
{
- if (i < (int)parkings.size() && i >= 0)
- return (parkings[i].getName());
- else
+ FGParkingVecIterator i = parkings.begin();
+ for (i = parkings.begin(); i != parkings.end(); i++)
+ {
+ if (id == i->getIndex()) {
+ return i->getName();
+ }
+ }
+
return string("overflow");
}
void FGAirportDynamics::releaseParking(int id)
//cerr << "Exiting due to not implemented yet" << endl;
//exit(1);
}
-void FGAirportDynamics::getActiveRunway(const string &trafficType, int action, string &runway)
+
+bool FGAirportDynamics::innerGetActiveRunway(const string &trafficType, int action, string &runway, double heading)
{
- double windSpeed;
+double windSpeed;
double windHeading;
double maxTail;
double maxCross;
string name;
string type;
- if (!(rwyPrefs.available()))
- {
- runway = chooseRunwayFallback();
- return; // generic fall back goes here
- }
- else
- {
- RunwayGroup *currRunwayGroup = 0;
- int nrActiveRunways = 0;
- time_t dayStart = fgGetLong("/sim/time/utc/day-seconds");
- if ((abs((long)(dayStart - lastUpdate)) > 600) || trafficType != prevTrafficType)
+ if (!rwyPrefs.available()) {
+ return false;
+ }
+
+ RunwayGroup *currRunwayGroup = 0;
+ int nrActiveRunways = 0;
+ time_t dayStart = fgGetLong("/sim/time/utc/day-seconds");
+ if ((abs((long)(dayStart - lastUpdate)) > 600) || trafficType != prevTrafficType)
{
landing.clear();
takeoff.clear();
windSpeed = stationweather.get_wind_speed_kt();
windHeading = stationweather.get_wind_from_heading_deg();
- // double averageWindSpeed = 0;
-// double averageWindHeading = 0;
-// double cosHeading = 0;
-// double sinHeading = 0;
-// // Initialize at the beginning of the next day or startup
-// if ((lastUpdate == 0) || (dayStart < lastUpdate))
-// {
-// for (int i = 0; i < 10; i++)
-// {
-// avWindHeading [i] = windHeading;
-// avWindSpeed [i] = windSpeed;
-// }
-// }
-// else
-// {
-// if (windSpeed != avWindSpeed[9]) // update if new metar data
-// {
-// // shift the running average
-// for (int i = 0; i < 9 ; i++)
-// {
-// avWindHeading[i] = avWindHeading[i+1];
-// avWindSpeed [i] = avWindSpeed [i+1];
-// }
-// }
-// avWindHeading[9] = windHeading;
-// avWindSpeed [9] = windSpeed;
-// }
-
-// for (int i = 0; i < 10; i++)
-// {
-// averageWindSpeed += avWindSpeed [i];
-// //averageWindHeading += avWindHeading [i];
-// cosHeading += cos(avWindHeading[i] * SG_DEGREES_TO_RADIANS);
-// sinHeading += sin(avWindHeading[i] * SG_DEGREES_TO_RADIANS);
-// }
-// averageWindSpeed /= 10;
-// //averageWindHeading /= 10;
-// cosHeading /= 10;
-// sinHeading /= 10;
-// averageWindHeading = atan2(sinHeading, cosHeading) *SG_RADIANS_TO_DEGREES;
-// if (averageWindHeading < 0)
-// averageWindHeading += 360.0;
-// //cerr << "Wind Heading " << windHeading << " average " << averageWindHeading << endl;
-// //cerr << "Wind Speed " << windSpeed << " average " << averageWindSpeed << endl;
-// lastUpdate = dayStart;
-// //if (wind_speed == 0) {
-// // wind_heading = 270; This forces West-facing rwys to be used in no-wind situations
-// // which is consistent with Flightgear's initial setup.
-// //}
-
- //string rwy_no = globals->get_runways()->search(apt->getId(), int(wind_heading));
string scheduleName;
//cerr << "finding active Runway for" << _ap->getId() << endl;
//cerr << "Nr of seconds since day start << " << dayStart << endl;
//cerr << "A"<< endl;
currSched = rwyPrefs.getSchedule(trafficType.c_str());
if (!(currSched))
- return;
+ return false;
//cerr << "B"<< endl;
scheduleName = currSched->getName(dayStart);
maxTail = currSched->getTailWind ();
maxCross = currSched->getCrossWind ();
//cerr << "SChedule anme = " << scheduleName << endl;
if (scheduleName.empty())
- return;
+ return false;
//cerr << "C"<< endl;
currRunwayGroup = rwyPrefs.getGroup(scheduleName);
//cerr << "D"<< endl;
if (!(currRunwayGroup))
- return;
+ return false;
nrActiveRunways = currRunwayGroup->getNrActiveRunways();
- //cerr << "Nr of Active Runways = " << nrActiveRunways << endl;
+ // Keep a history of the currently active runways, to ensure
+ // that an already established selection of runways will not
+ // be overridden once a more preferred selection becomes
+ // available as that can lead to random runway swapping.
+ if (trafficType == "com") {
+ currentlyActive = &comActive;
+ } else if (trafficType == "gen") {
+ currentlyActive = &genActive;
+ } else if (trafficType == "mil") {
+ currentlyActive = &milActive;
+ } else if (trafficType == "ul") {
+ currentlyActive = &ulActive;
+ }
//
- currRunwayGroup->setActive(_ap->getId(),
+ currRunwayGroup->setActive(_ap,
windSpeed,
windHeading,
maxTail,
maxCross,
- ¤tlyActive);
+ currentlyActive);
- // Note that I SHOULD keep three lists in memory, one for
+ // Note that I SHOULD keep multiple lists in memory, one for
// general aviation, one for commercial and one for military
// traffic.
- currentlyActive.clear();
+ currentlyActive->clear();
nrActiveRunways = currRunwayGroup->getNrActiveRunways();
+ //cerr << "Choosing runway for " << trafficType << endl;
for (int i = 0; i < nrActiveRunways; i++)
{
type = "unknown"; // initialize to something other than landing or takeoff
if (type == "landing")
{
landing.push_back(name);
- currentlyActive.push_back(name);
+ currentlyActive->push_back(name);
//cerr << "Landing " << name << endl;
}
if (type == "takeoff")
{
takeoff.push_back(name);
- currentlyActive.push_back(name);
+ currentlyActive->push_back(name);
//cerr << "takeoff " << name << endl;
}
}
+ //cerr << endl;
}
- if (action == 1) // takeoff
+
+ if (action == 1) // takeoff
{
int nr = takeoff.size();
if (nr)
// Note that the randomization below, is just a placeholder to choose between
// multiple active runways for this action. This should be
// under ATC control.
- runway = takeoff[(rand() % nr)];
+ runway = chooseRwyByHeading (takeoff, heading);
}
else
{ // Fallback
runway = chooseRunwayFallback();
}
}
- if (action == 2) // landing
+
+ if (action == 2) // landing
{
int nr = landing.size();
if (nr)
{
- runway = landing[(rand() % nr)];
+ runway = chooseRwyByHeading (landing, heading);
}
else
{ //fallback
runway = chooseRunwayFallback();
}
- }
-
- //runway = globals->get_runways()->search(_ap->getId(), int(windHeading));
- //cerr << "Seleceted runway: " << runway << endl;
- }
+ }
+
+ return true;
+}
+
+string FGAirportDynamics::chooseRwyByHeading(stringVec rwys, double heading) {
+ double bestError = 360.0;
+ double rwyHeading, headingError;
+ string runway;
+ for (stringVecIterator i = rwys.begin(); i != rwys.end(); i++) {
+ FGRunway *rwy = _ap->getRunwayByIdent((*i));
+ rwyHeading = rwy->headingDeg();
+ headingError = fabs(heading - rwyHeading);
+ if (headingError > 180)
+ headingError = fabs(headingError - 360);
+ if (headingError < bestError) {
+ runway = (*i);
+ bestError = headingError;
+ }
+ }
+ //cerr << "Using active runway " << runway << " for heading " << heading << endl;
+ return runway;
+}
+
+void FGAirportDynamics::getActiveRunway(const string &trafficType, int action, string &runway, double heading)
+{
+ bool ok = innerGetActiveRunway(trafficType, action, runway, heading);
+ if (!ok) {
+ runway = chooseRunwayFallback();
+ }
}
string FGAirportDynamics::chooseRunwayFallback()
{
- FGEnvironment
- stationweather = ((FGEnvironmentMgr *) globals->get_subsystem("environment"))
- ->getEnvironment(getLatitude(),
- getLongitude(),
- getElevation());
-
- double windSpeed = stationweather.get_wind_speed_kt();
- double windHeading = stationweather.get_wind_from_heading_deg();
- if (windSpeed == 0) {
- windHeading = 270; // This forces West-facing rwys to be used in no-wind situations
- //which is consistent with Flightgear's initial setup.
- }
-
- return globals->get_runways()->search(_ap->getId(), int(windHeading));
+ FGRunway* rwy = _ap->getActiveRunwayForUsage();
+ return rwy->ident();
}
void FGAirportDynamics::addParking(FGParking& park) {
const string& FGAirportDynamics::getId() const {
return _ap->getId();
}
+
+// Experimental: Return a different ground frequency depending on the leg of the
+// Flight. Leg should always have a minimum value of two when this function is called.
+// Note that in this scheme, the assignment of various frequencies to various ground
+// operations is completely arbitrary. As such, is a short cut I need to take now,
+// so that at least I can start working on assigning different frequencies to different
+// operations.
+
+int FGAirportDynamics::getGroundFrequency(unsigned leg) {
+ //return freqGround.size() ? freqGround[0] : 0; };
+ int groundFreq = 0;
+ if (leg < 2) {
+ SG_LOG(SG_ATC, SG_ALERT, "Leg value is smaller than two at " << SG_ORIGIN);
+ }
+ if (freqGround.size() == 0) {
+ return 0;
+ }
+ if ((freqGround.size() > leg-1) && (leg > 1)) {
+ groundFreq = freqGround[leg-1];
+ }
+ if ((freqGround.size() < leg-1) && (leg > 1)) {
+ groundFreq = (freqGround.size() < (leg-1)) ? freqGround[freqGround.size()-1] : freqGround[leg-2];
+ }
+ if ((freqGround.size() >= leg-1) && (leg > 1)) {
+ groundFreq = freqGround[leg-2];
+ }
+ return groundFreq;
+}
+
+FGAIFlightPlan *FGAirportDynamics::getSID(string activeRunway, double heading)
+{
+ return SIDs.getBest(activeRunway, heading);
+}