X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FAirports%2Fsimple.cxx;h=a085fab57ab7804084100bb8cea4983decb7672a;hb=c859833c63d410df84cecd86a2a2e4b60a71821c;hp=af1e0de195e04eb42219494a52aaed80ce140e6d;hpb=660d59a098c1033571337da0938c79906a577f4a;p=flightgear.git diff --git a/src/Airports/simple.cxx b/src/Airports/simple.cxx index af1e0de19..a085fab57 100644 --- a/src/Airports/simple.cxx +++ b/src/Airports/simple.cxx @@ -28,29 +28,28 @@ # include #endif -#include -#include +#include "simple.hxx" -#include +#include -#include -#include #include #include -#include +#include #include -#include
+#include + +#include +#include #include
#include +#include #include +#include +#include +#include -#include - -#include "simple.hxx" -#include "xmlloader.hxx" - -using std::sort; -using std::random_shuffle; +using std::vector; +using namespace flightgear; // magic import of a helper which uses FGPositioned internals extern char** searchAirportNamesAndIdents(const std::string& aFilter); @@ -65,8 +64,11 @@ FGAirport::FGAirport(const string &id, const SGGeod& location, const SGGeod& tow _tower_location(tower_location), _name(name), _has_metar(has_metar), - _dynamics(0) + _dynamics(0), + mRunwaysLoaded(false), + mTaxiwaysLoaded(true) { + init(true); // init FGPositioned } @@ -102,17 +104,23 @@ FGAirportDynamics * FGAirport::getDynamics() FGRunwayPreference rwyPrefs(this); XMLLoader::load(&rwyPrefs); _dynamics->setRwyUse(rwyPrefs); + + //FGSidStar SIDs(this); + XMLLoader::load(_dynamics->getSIDs()); } return _dynamics; } unsigned int FGAirport::numRunways() const { + loadRunways(); return mRunways.size(); } FGRunway* FGAirport::getRunwayByIndex(unsigned int aIndex) const { + loadRunways(); + assert(aIndex >= 0 && aIndex < mRunways.size()); return mRunways[aIndex]; } @@ -136,6 +144,11 @@ FGRunway* FGAirport::getRunwayByIdent(const string& aIdent) const FGAirport::Runway_iterator FGAirport::getIteratorForRunwayIdent(const string& aIdent) const { + if (aIdent.empty()) + return mRunways.end(); + + loadRunways(); + string ident(aIdent); if ((aIdent.size() == 1) || !isdigit(aIdent[1])) { ident = "0" + aIdent; @@ -151,21 +164,10 @@ FGAirport::getIteratorForRunwayIdent(const string& aIdent) const return it; // end() } -static double normaliseBearing(double aBearing) -{ - while (aBearing < -180) { - aBearing += 360.0; - } - - while (aBearing > 180.0) { - aBearing -= 360.0; - } - - return aBearing; -} - FGRunway* FGAirport::findBestRunwayForHeading(double aHeading) const { + loadRunways(); + Runway_iterator it = mRunways.begin(); FGRunway* result = NULL; double currentBestQuality = 0.0; @@ -179,7 +181,8 @@ FGRunway* FGAirport::findBestRunwayForHeading(double aHeading) const for (; it != mRunways.end(); ++it) { double good = (*it)->score(lengthWeight, widthWeight, surfaceWeight); - double dev = normaliseBearing(aHeading - (*it)->headingDeg()); + double dev = aHeading - (*it)->headingDeg(); + SG_NORMALIZE_RANGE(dev, -180.0, 180.0); double bad = fabs(deviationWeight * dev) + 1e-20; double quality = good / bad; @@ -192,8 +195,34 @@ FGRunway* FGAirport::findBestRunwayForHeading(double aHeading) const return result; } +FGRunway* FGAirport::findBestRunwayForPos(const SGGeod& aPos) const +{ + loadRunways(); + + Runway_iterator it = mRunways.begin(); + FGRunway* result = NULL; + double currentLowestDev = 180.0; + + for (; it != mRunways.end(); ++it) { + double inboundCourse = SGGeodesy::courseDeg(aPos, (*it)->end()); + double dev = inboundCourse - (*it)->headingDeg(); + SG_NORMALIZE_RANGE(dev, -180.0, 180.0); + + dev = fabs(dev); + if (dev < currentLowestDev) { // new best match + currentLowestDev = dev; + result = *it; + } + } // of runway iteration + + return result; + +} + bool FGAirport::hasHardRunwayOfLengthFt(double aLengthFt) const { + loadRunways(); + unsigned int numRunways(mRunways.size()); for (unsigned int r=0; r= 0 && aIndex < mTaxiways.size()); return mTaxiways[aIndex]; } -void FGAirport::addRunway(FGRunway* aRunway) +unsigned int FGAirport::numPavements() const { - aRunway->setAirport(this); - - if (aRunway->isTaxiway()) { - mTaxiways.push_back(aRunway); - } else { - mRunways.push_back(aRunway); + loadTaxiways(); + return mPavements.size(); +} + +FGPavement* FGAirport::getPavementByIndex(unsigned int aIndex) const +{ + loadTaxiways(); + assert(aIndex >= 0 && aIndex < mPavements.size()); + return mPavements[aIndex]; +} + +void FGAirport::setRunwaysAndTaxiways(vector& rwys, + vector& txwys, + vector& pvts) +{ + mRunways.swap(rwys); + Runway_iterator it = mRunways.begin(); + for (; it != mRunways.end(); ++it) { + (*it)->setAirport(this); } + + mTaxiways.swap(txwys); + mPavements.swap(pvts); } FGRunway* FGAirport::getActiveRunwayForUsage() const @@ -238,13 +285,17 @@ FGRunway* FGAirport::getActiveRunwayForUsage() const envMgr = (FGEnvironmentMgr *) globals->get_subsystem("environment"); } - FGEnvironment stationWeather(envMgr->getEnvironment(mPosition)); + // This forces West-facing rwys to be used in no-wind situations + // which is consistent with Flightgear's initial setup. + double hdg = 270; - double windSpeed = stationWeather.get_wind_speed_kt(); - double hdg = stationWeather.get_wind_from_heading_deg(); - if (windSpeed <= 0.0) { - hdg = 270; // This forces West-facing rwys to be used in no-wind situations - // which is consistent with Flightgear's initial setup. + if (envMgr) { + FGEnvironment stationWeather(envMgr->getEnvironment(mPosition)); + + double windSpeed = stationWeather.get_wind_speed_kt(); + if (windSpeed > 0.0) { + hdg = stationWeather.get_wind_from_heading_deg(); + } } return findBestRunwayForHeading(hdg); @@ -270,19 +321,15 @@ FGAirport::HardSurfaceFilter::HardSurfaceFilter(double minLengthFt) : { } -bool FGAirport::HardSurfaceFilter::pass(FGPositioned* aPos) const +bool FGAirport::HardSurfaceFilter::passAirport(FGAirport* aApt) const { - if (aPos->type() != AIRPORT) { - return false; // exclude seaports and heliports as well, we need a runways - } - - return static_cast(aPos)->hasHardRunwayOfLengthFt(mMinLengthFt); + return aApt->hasHardRunwayOfLengthFt(mMinLengthFt); } FGAirport* FGAirport::findByIdent(const std::string& aIdent) { FGPositionedRef r; - AirportFilter filter; + PortsFilter filter; r = FGPositioned::findNextWithPartialId(r, aIdent, &filter); if (!r) { return NULL; // we don't warn here, let the caller do that @@ -293,7 +340,7 @@ FGAirport* FGAirport::findByIdent(const std::string& aIdent) FGAirport* FGAirport::getByIdent(const std::string& aIdent) { FGPositionedRef r; - AirportFilter filter; + PortsFilter filter; r = FGPositioned::findNextWithPartialId(r, aIdent, &filter); if (!r) { throw sg_range_exception("No such airport with ident: " + aIdent); @@ -308,66 +355,316 @@ char** FGAirport::searchNamesAndIdents(const std::string& aFilter) return searchAirportNamesAndIdents(aFilter); } -/****************************************************************************** - * FGAirportList - *****************************************************************************/ +// find basic airport location info from airport database +const FGAirport *fgFindAirportID( const string& id) +{ + if ( id.empty() ) { + return NULL; + } + + return FGAirport::findByIdent(id); +} -FGAirportList::FGAirportList() +void FGAirport::loadRunways() const { + if (mRunwaysLoaded) { + return; // already loaded, great + } + + mRunwaysLoaded = true; + loadSceneryDefinitions(); } +void FGAirport::loadTaxiways() const +{ + if (mTaxiwaysLoaded) { + return; // already loaded, great + } +} -FGAirportList::~FGAirportList( void ) +void FGAirport::loadProcedures() const { - for (unsigned int i = 0; i < airports_array.size(); ++i) { - delete airports_array[i]; - } + if (mProceduresLoaded) { + return; + } + + mProceduresLoaded = true; + SGPath path; + if (!XMLLoader::findAirportData(ident(), "procedures", path)) { + SG_LOG(SG_GENERAL, SG_INFO, "no procedures data available for " << ident()); + return; + } + + SG_LOG(SG_GENERAL, SG_INFO, ident() << ": loading procedures from " << path.str()); + Route::loadAirportProcedures(path, const_cast(this)); } +void FGAirport::loadSceneryDefinitions() const +{ + // allow users to disable the scenery data in the short-term + // longer term, this option can probably disappear + if (!fgGetBool("/sim/paths/use-custom-scenery-data")) { + return; + } + + SGPath path; + SGPropertyNode_ptr rootNode = new SGPropertyNode; + if (XMLLoader::findAirportData(ident(), "threshold", path)) { + readProperties(path.str(), rootNode); + const_cast(this)->readThresholdData(rootNode); + } + + // repeat for the tower data + rootNode = new SGPropertyNode; + if (XMLLoader::findAirportData(ident(), "twr", path)) { + readProperties(path.str(), rootNode); + const_cast(this)->readTowerData(rootNode); + } +} -// add an entry to the list -FGAirport* FGAirportList::add( const string &id, const SGGeod& location, const SGGeod& tower_location, - const string &name, bool has_metar, FGPositioned::Type aType) +void FGAirport::readThresholdData(SGPropertyNode* aRoot) { - FGAirport* a = new FGAirport(id, location, tower_location, name, has_metar, aType); - // try and read in an auxilary file - airports_array.push_back( a ); - return a; + SGPropertyNode* runway; + int runwayIndex = 0; + for (; (runway = aRoot->getChild("runway", runwayIndex)) != NULL; ++runwayIndex) { + SGPropertyNode* t0 = runway->getChild("threshold", 0), + *t1 = runway->getChild("threshold", 1); + assert(t0); + assert(t1); // too strict? mayeb we should finally allow single-ended runways + + processThreshold(t0); + processThreshold(t1); + } // of runways iteration } -int -FGAirportList::size () const +void FGAirport::processThreshold(SGPropertyNode* aThreshold) { - return airports_array.size(); + // first, let's identify the current runway + string id(aThreshold->getStringValue("rwy")); + if (!hasRunwayWithIdent(id)) { + SG_LOG(SG_GENERAL, SG_WARN, "FGAirport::processThreshold: " + "found runway not defined in the global data:" << ident() << "/" << id); + return; + } + + FGRunway* rwy = getRunwayByIdent(id); + rwy->processThreshold(aThreshold); } +void FGAirport::readTowerData(SGPropertyNode* aRoot) +{ + SGPropertyNode* twrNode = aRoot->getChild("tower")->getChild("twr"); + double lat = twrNode->getDoubleValue("lat"), + lon = twrNode->getDoubleValue("lon"), + elevM = twrNode->getDoubleValue("elev-m"); +// tower elevation is AGL, not AMSL. Since we don't want to depend on the +// scenery for a precise terrain elevation, we use the field elevation +// (this is also what the apt.dat code does) + double fieldElevationM = geod().getElevationM(); + + _tower_location = SGGeod::fromDegM(lon, lat, fieldElevationM + elevM); +} -const FGAirport *FGAirportList::getAirport( unsigned int index ) const +bool FGAirport::buildApproach(Waypt* aEnroute, STAR* aSTAR, FGRunway* aRwy, WayptVec& aRoute) { - if (index < airports_array.size()) { - return(airports_array[index]); - } else { - return(NULL); + loadProcedures(); + + if ((aRwy && (aRwy->airport() != this))) { + throw sg_exception("invalid parameters", "FGAirport::buildApproach"); + } + + if (aSTAR) { + bool ok = aSTAR->route(aRwy, aEnroute, aRoute); + if (!ok) { + SG_LOG(SG_GENERAL, SG_WARN, ident() << ": build approach, STAR " << aSTAR->ident() + << " failed to route from transition " << aEnroute->ident()); + return false; + } + } else if (aEnroute) { + // no a STAR specified, just use enroute point directly + aRoute.push_back(aEnroute); + } + + if (!aRwy) { + // no runway selected yet, but we loaded the STAR, so that's fine, we're done + return true; + } + +// build the approach (possibly including transition), and including the missed segment + vector aps; + for (unsigned int j=0; jrunway() == aRwy) { + aps.push_back(mApproaches[j]); + } + } // of approach filter by runway + + if (aps.empty()) { + SG_LOG(SG_GENERAL, SG_INFO, ident() << "; no approaches defined for runway " << aRwy->ident()); + // could build a fallback approach here + return false; + } + + for (unsigned int k=0; kroute(aRoute.back(), aRoute)) { + return true; } + } // of initial approach iteration + + SG_LOG(SG_GENERAL, SG_INFO, ident() << ": unable to find transition to runway " + << aRwy->ident() << ", assume vectors"); + + WayptRef v(new ATCVectors(NULL, this)); + aRoute.push_back(v); + return aps.front()->routeFromVectors(aRoute); } -// find basic airport location info from airport database -const FGAirport *fgFindAirportID( const string& id) +pair +FGAirport::selectSID(const SGGeod& aDest, FGRunway* aRwy) { - if ( id.empty() ) { - return NULL; + loadProcedures(); + + WayptRef enroute; + flightgear::SID* sid = NULL; + double d = 1e9; + + for (unsigned int i=0; iisForRunway(aRwy)) { + continue; + } + + WayptRef e = mSIDs[i]->findBestTransition(aDest); + if (!e) { + continue; // strange, but let's not worry about it } - return FGAirport::findByIdent(id); + // assert(e->isFixedPosition()); + double ed = SGGeodesy::distanceM(aDest, e->position()); + if (ed < d) { // new best match + enroute = e; + d = ed; + sid = mSIDs[i]; + } + } // of SID iteration + + if (!mSIDs.empty() && !sid) { + SG_LOG(SG_GENERAL, SG_INFO, ident() << "selectSID, no SID found (runway=" + << (aRwy ? aRwy->ident() : "no runway preference")); + } + + return make_pair(sid, enroute); +} + +pair +FGAirport::selectSTAR(const SGGeod& aOrigin, FGRunway* aRwy) +{ + loadProcedures(); + + WayptRef enroute; + STAR* star = NULL; + double d = 1e9; + + for (unsigned int i=0; iisForRunway(aRwy)) { + continue; + } + + SG_LOG(SG_GENERAL, SG_INFO, "STAR " << mSTARs[i]->ident() << " is valid for runway"); + WayptRef e = mSTARs[i]->findBestTransition(aOrigin); + if (!e) { + continue; // strange, but let's not worry about it + } + + // assert(e->isFixedPosition()); + double ed = SGGeodesy::distanceM(aOrigin, e->position()); + if (ed < d) { // new best match + enroute = e; + d = ed; + star = mSTARs[i]; + } + } // of STAR iteration + + return make_pair(star, enroute); +} + + +void FGAirport::addSID(flightgear::SID* aSid) +{ + mSIDs.push_back(aSid); +} + +void FGAirport::addSTAR(STAR* aStar) +{ + mSTARs.push_back(aStar); +} + +void FGAirport::addApproach(Approach* aApp) +{ + mApproaches.push_back(aApp); +} + +unsigned int FGAirport::numSIDs() const +{ + loadProcedures(); + return mSIDs.size(); +} + +flightgear::SID* FGAirport::getSIDByIndex(unsigned int aIndex) const +{ + loadProcedures(); + return mSIDs[aIndex]; +} + +flightgear::SID* FGAirport::findSIDWithIdent(const std::string& aIdent) const +{ + loadProcedures(); + for (unsigned int i=0; iident() == aIdent) { + return mSIDs[i]; + } + } + + return NULL; +} + +unsigned int FGAirport::numSTARs() const +{ + loadProcedures(); + return mSTARs.size(); +} + +STAR* FGAirport::getSTARByIndex(unsigned int aIndex) const +{ + loadProcedures(); + return mSTARs[aIndex]; +} + +STAR* FGAirport::findSTARWithIdent(const std::string& aIdent) const +{ + loadProcedures(); + for (unsigned int i=0; iident() == aIdent) { + return mSTARs[i]; + } + } + + return NULL; +} + +unsigned int FGAirport::numApproaches() const +{ + loadProcedures(); + return mApproaches.size(); } +Approach* FGAirport::getApproachByIndex(unsigned int aIndex) const +{ + loadProcedures(); + return mApproaches[aIndex]; +} // get airport elevation double fgGetAirportElev( const string& id ) { - SG_LOG( SG_GENERAL, SG_BULK, - "Finding elevation for airport: " << id ); - const FGAirport *a=fgFindAirportID( id); if (a) { return a->getElevation(); @@ -378,16 +675,13 @@ double fgGetAirportElev( const string& id ) // get airport position -Point3D fgGetAirportPos( const string& id ) +SGGeod fgGetAirportPos( const string& id ) { - SG_LOG( SG_ATC, SG_BULK, - "Finding position for airport: " << id ); - const FGAirport *a = fgFindAirportID( id); if (a) { - return Point3D(a->getLongitude(), a->getLatitude(), a->getElevation()); + return SGGeod::fromDegM(a->getLongitude(), a->getLatitude(), a->getElevation()); } else { - return Point3D(0.0, 0.0, -9999.0); + return SGGeod::fromDegM(0.0, 0.0, -9999.0); } }