# include <config.h>
#endif
-#include <math.h> // fabs()
-#include <stdio.h> // sprintf()
+#include <cstdio> // sprintf()
+#include <cstdlib> // atoi()
+#include <cassert>
#include <simgear/compiler.h>
-#include <simgear/debug/logstream.hxx>
+#include <simgear/props/props.hxx>
-#include STL_STRING
-#include <map>
+#include <string>
#include "runways.hxx"
-SG_USING_NAMESPACE(std);
-SG_USING_STD(istream);
-SG_USING_STD(multimap);
+#include <Airports/simple.hxx>
+#include <Navaids/procedure.hxx>
+using std::string;
-// add an entry to the list
-void FGRunwayList::add( const string& id, const string& rwy_no,
- const double longitude, const double latitude,
- const double heading, const double length,
- const double width,
- const double displ_thresh1, const double displ_thresh2,
- const double stopway1, const double stopway2,
- const string& lighting_flags, const int surface_code,
- const string& shoulder_code, const int marking_code,
- const double smoothness, const bool dist_remaining )
+static std::string cleanRunwayNo(const std::string& aRwyNo)
{
- FGRunway rwy;
-
- rwy._id = id;
- rwy._rwy_no = rwy_no;
- // strip trailing "x" if it exists in runway number
- string tmp = rwy._rwy_no.substr(2, 1);
- if ( tmp == "x" ) {
- rwy._rwy_no = rwy._rwy_no.substr(0, 2);
+ if (aRwyNo[0] == 'x') {
+ return std::string(); // no ident for taxiways
+ }
+
+ string result(aRwyNo);
+ // canonicalise runway ident
+ if ((aRwyNo.size() == 1) || !isdigit(aRwyNo[1])) {
+ result = "0" + aRwyNo;
+ }
+
+ // trim off trailing garbage
+ if (result.size() > 2) {
+ char suffix = toupper(result[2]);
+ if (suffix == 'X') {
+ result = result.substr(0, 2);
}
+ }
+
+ return result;
+}
- rwy._lon = longitude;
- rwy._lat = latitude;
- rwy._heading = heading;
- rwy._length = length;
- rwy._width = width;
- rwy._displ_thresh1 = displ_thresh1;
- rwy._displ_thresh2 = displ_thresh2;
- rwy._stopway1 = stopway1;
- rwy._stopway2 = stopway2;
-
- rwy._lighting_flags = lighting_flags;
- rwy._surface_code = surface_code;
- rwy._shoulder_code = shoulder_code;
- rwy._marking_code = marking_code;
- rwy._smoothness = smoothness;
- rwy._dist_remaining = dist_remaining;
-
- if ( rwy_no[0] == 'x' ) {
- rwy._type = "taxiway";
- } else {
- rwy._type = "runway";
- }
- runways.insert(pair<const string, FGRunway>(rwy._id, rwy));
+FGRunway::FGRunway(FGAirport* aAirport, const string& aIdent,
+ const SGGeod& aGeod,
+ const double heading, const double length,
+ const double width,
+ const double displ_thresh,
+ const double stopway,
+ const int surface_code,
+ bool reciprocal) :
+ FGRunwayBase(RUNWAY, cleanRunwayNo(aIdent), aGeod, heading, length, width, surface_code, true),
+ _airport(aAirport),
+ _isReciprocal(reciprocal),
+ _reciprocal(NULL),
+ _displ_thresh(displ_thresh),
+ _stopway(stopway),
+ _ils(NULL)
+{
}
+string FGRunway::reverseIdent(const string& aRunwayIdent)
+{
+ // Helipads don't have a seperate number per end
+ if (aRunwayIdent.size() && (aRunwayIdent[0] == 'H' || aRunwayIdent[0] == 'h' || aRunwayIdent[0] == 'x')) {
+ return aRunwayIdent;
+ }
-// Return reverse rwy number
-// eg 01 -> 19
-// 03L -> 21R
-static string GetReverseRunwayNo(string& rwyno) {
- // cout << "Original rwyno = " << rwyNo << '\n';
-
- // Helipads don't have a seperate number per end
- if(rwyno.size() && (rwyno[0] == 'H' || rwyno[0] == 'h' || rwyno[0] == 'x')) {
- return rwyno;
- }
+ std::string ident(aRunwayIdent);
- // standardize input number
- string tmp = rwyno.substr(1, 1);
- if (( tmp == "L" || tmp == "R" || tmp == "C" ) || (rwyno.size() == 1)) {
- tmp = rwyno;
- rwyno = "0" + tmp;
- SG_LOG( SG_GENERAL, SG_INFO,
- "Standardising rwy number from " << tmp << " to " << rwyno );
+ char buf[4];
+ int rn = atoi(ident.substr(0,2).c_str());
+ rn += 18;
+ while(rn > 36) {
+ rn -= 36;
+ }
+
+ sprintf(buf, "%02i", rn);
+ if(ident.size() == 3) {
+ char suffix = toupper(ident[2]);
+ if(suffix == 'L') {
+ buf[2] = 'R';
+ } else if (suffix == 'R') {
+ buf[2] = 'L';
+ } else {
+ // something else, just copy
+ buf[2] = suffix;
}
- char buf[4];
- int rn = atoi(rwyno.substr(0,2).c_str());
- rn += 18;
- while(rn > 36) {
- rn -= 36;
- }
- sprintf(buf, "%02i", rn);
- if(rwyno.size() == 3) {
- if(rwyno.substr(2,1) == "L") {
- buf[2] = 'R';
- buf[3] = '\0';
- } else if (rwyno.substr(2,1) == "R") {
- buf[2] = 'L';
- buf[3] = '\0';
- } else if (rwyno.substr(2,1) == "C") {
- buf[2] = 'C';
- buf[3] = '\0';
- } else if (rwyno.substr(2,1) == "T") {
- buf[2] = 'T';
- buf[3] = '\0';
- } else {
- SG_LOG(SG_GENERAL, SG_ALERT, "Unknown runway code "
- << rwyno << " passed to GetReverseRunwayNo(...)");
- }
- }
- return(buf);
+ buf[3] = 0;
+ }
+
+ return buf;
}
-
-// search for the specified apt id (wierd!)
-bool FGRunwayList::search( const string& aptid, FGRunway* r ) {
- runway_map_iterator pos;
-
- pos = runways.lower_bound(aptid);
- if ( pos != runways.end() ) {
- current = pos;
- *r = pos->second;
- return true;
- } else {
- return false;
- }
+double FGRunway::score(double aLengthWt, double aWidthWt, double aSurfaceWt) const
+{
+ int surface = 1;
+ if (_surface_code == 12 || _surface_code == 5) // dry lakebed & gravel
+ surface = 2;
+ else if (_surface_code == 1 || _surface_code == 2) // asphalt & concrete
+ surface = 3;
+
+ return _length * aLengthWt + _width * aWidthWt + surface * aSurfaceWt + 1e-20;
}
-
-// search for the specified apt id and runway no
-bool FGRunwayList::search( const string& aptid, const string& rwyno,
- FGRunway *r )
+SGGeod FGRunway::begin() const
{
- string revrwyno = "";
- string runwayno = rwyno;
- if ( runwayno.length() ) {
- // standardize input number
- string tmp = runwayno.substr(1, 1);
- if (( tmp == "L" || tmp == "R" || tmp == "C" )
- || (runwayno.size() == 1))
- {
- tmp = runwayno;
- runwayno = "0" + tmp;
- SG_LOG( SG_GENERAL, SG_INFO, "Standardising rwy number from "
- << tmp << " to " << runwayno );
- }
- revrwyno = GetReverseRunwayNo(runwayno);
- }
- runway_map_iterator pos;
- for ( pos = runways.lower_bound( aptid );
- pos != runways.upper_bound( aptid ); ++pos)
- {
- if ( pos->second._rwy_no == runwayno ) {
- current = pos;
- *r = pos->second;
- return true;
- } else if ( pos->second._rwy_no == revrwyno ) {
- // Search again with the other-end runway number.
- // Remember we have to munge the heading and rwy_no
- // results if this one matches
- current = pos;
- *r = pos->second;
- // NOTE - matching revrwyno implies that runwayno was
- // actually correct.
- r->_rwy_no = runwayno;
- r->_heading += 180.0;
- return true;
- }
- }
-
- return false;
+ return pointOnCenterline(0.0);
}
-
-// (wierd!)
-FGRunway FGRunwayList::search( const string& aptid ) {
- FGRunway a;
- search( aptid, &a );
- return a;
+SGGeod FGRunway::end() const
+{
+ return pointOnCenterline(lengthM());
}
-
-// Return the runway closest to a given heading
-bool FGRunwayList::search( const string& aptid, const int tgt_hdg,
- FGRunway *runway )
+SGGeod FGRunway::threshold() const
{
- string rwyNo = search(aptid, tgt_hdg);
- return(rwyNo == "NN" ? false : search(aptid, rwyNo, runway));
+ return pointOnCenterline(_displ_thresh * SG_FEET_TO_METER);
}
-
-// Return the runway number of the runway closest to a given heading
-#include <Main/fg_props.hxx> // FIXME remove
-string FGRunwayList::search( const string& aptid, const int hdg ) {
- //SG_LOG(SG_GENERAL, SG_DEBUG, "searching runway for " << aptid
- // << " with target heading " << hdg);
-
- FGRunway r;
- if (!search(aptid, &r)) {
- SG_LOG(SG_GENERAL, SG_ALERT, "Failed to find "
- << aptid << " in database.");
- return "NN";
- }
-
- double LENWGT = fgGetDouble("/tmp/runway-search/length", 0.01);
- double WIDWGT = fgGetDouble("/tmp/runway-search/width", 0.01);
- double SURFWGT = fgGetDouble("/tmp/runway-search/surface", 10);
- double DEVWGT = fgGetDouble("/tmp/runway-search/deviation", 1);
-
- FGRunway best;
- double max = 0.0;
- bool reversed = false;
-
- while (r._id == aptid) {
- if (r._type != "runway")
- continue;
-
- int surface = 0;
- if (r._surface_code == 1 || r._surface_code == 2) // asphalt & concrete
- surface = 2;
- else if (r._surface_code == 12 || r._surface_code == 5) // dry lakebed & gravel
- surface = 1;
-
- double quality, bad, diff;
- double good = LENWGT * r._length + WIDWGT * r._width + SURFWGT * surface;
-
- // this side
- diff = hdg - r._heading;
- while (diff < -180)
- diff += 360;
- while (diff >= 180)
- diff -= 360;
- bad = DEVWGT * fabs(diff) + 1e-20;
-
- quality = good / bad;
- //SG_LOG(SG_GENERAL, SG_DEBUG, " runway " << r._rwy_no << " -> " << quality);
- if (quality > max) {
- max = quality;
- best = r;
- reversed = false;
- }
-
- // other side
- diff = hdg - r._heading - 180;
- while (diff < -180)
- diff += 360;
- while (diff >= 180)
- diff -= 360;
- bad = DEVWGT * fabs(diff) + 1e-20;
-
- quality = good / bad;
- //SG_LOG(SG_GENERAL, SG_DEBUG, " runway " << GetReverseRunwayNo(r._rwy_no)
- // << " -> " << quality);
- if (quality > max) {
- max = quality;
- best = r;
- reversed = true;
- }
-
- if (!next(&r))
- break;
- }
-
- return reversed ? GetReverseRunwayNo(best._rwy_no) : best._rwy_no;
+void FGRunway::processThreshold(SGPropertyNode* aThreshold)
+{
+ assert(ident() == aThreshold->getStringValue("rwy"));
+
+ double lon = aThreshold->getDoubleValue("lon"),
+ lat = aThreshold->getDoubleValue("lat");
+ SGGeod newThreshold(SGGeod::fromDegM(lon, lat, mPosition.getElevationM()));
+
+ _heading = aThreshold->getDoubleValue("hdg-deg");
+ _displ_thresh = aThreshold->getDoubleValue("displ-m") * SG_METER_TO_FEET;
+ _stopway = aThreshold->getDoubleValue("stopw-m") * SG_METER_TO_FEET;
+
+ // compute the new runway center, based on the threshold lat/lon and length,
+ double offsetFt = (0.5 * _length);
+ SGGeod newCenter;
+ double dummy;
+ SGGeodesy::direct(newThreshold, _heading, offsetFt * SG_FEET_TO_METER, newCenter, dummy);
+ mPosition = newCenter;
+}
+
+void FGRunway::setReciprocalRunway(FGRunway* other)
+{
+ assert(_reciprocal==NULL);
+ assert((other->_reciprocal == NULL) || (other->_reciprocal == this));
+
+ _reciprocal = other;
}
-
-bool FGRunwayList::next( FGRunway* runway ) {
- ++current;
- if ( current != runways.end() ) {
- *runway = current->second;
- return true;
- } else {
- return false;
+std::vector<flightgear::SID*> FGRunway::getSIDs()
+{
+ std::vector<flightgear::SID*> result;
+ for (unsigned int i=0; i<_airport->numSIDs(); ++i) {
+ flightgear::SID* s = _airport->getSIDByIndex(i);
+ if (s->isForRunway(this)) {
+ result.push_back(s);
}
+ } // of SIDs at the airport iteration
+
+ return result;
}
-
-FGRunway FGRunwayList::next() {
- FGRunway result;
-
- ++current;
- if ( current != runways.end() ) {
- result = current->second;
+std::vector<flightgear::STAR*> FGRunway::getSTARs()
+{
+ std::vector<flightgear::STAR*> result;
+ for (unsigned int i=0; i<_airport->numSTARs(); ++i) {
+ flightgear::STAR* s = _airport->getSTARByIndex(i);
+ if (s->isForRunway(this)) {
+ result.push_back(s);
}
-
- return result;
+ } // of STARs at the airport iteration
+
+ return result;
}
-// Destructor
-FGRunwayList::~FGRunwayList( void ) {
-}
projects / flightgear.git / blobdiff