-// runways.hxx -- a simple class to manage airport runway info
+// runways.cxx -- a simple class to manage airport runway info
//
// Written by Curtis Olson, started August 2000.
//
-// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org
+// Copyright (C) 2000 Curtis L. Olson - http://www.flightgear.org/~curt
//
// This program is free software; you can redistribute it and/or
// modify it under the terms of the GNU General Public License as
//
// You should have received a copy of the GNU General Public License
// along with this program; if not, write to the Free Software
-// Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
//
// $Id$
# include <config.h>
#endif
-// #include <sys/types.h> // for gdbm open flags
-// #include <sys/stat.h> // for gdbm open flags
+#include <cmath> // fabs()
+#include <cstdio> // sprintf()
+#include <cstdlib> // atoi()
#include <simgear/compiler.h>
-
#include <simgear/debug/logstream.hxx>
-#include <simgear/misc/fgstream.hxx>
+#include <Main/fg_props.hxx>
#include STL_STRING
-#include STL_FUNCTIONAL
-#include STL_ALGORITHM
+#include <map>
#include "runways.hxx"
SG_USING_NAMESPACE(std);
+SG_USING_STD(istream);
+SG_USING_STD(multimap);
+
+
+// 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 )
+{
+ 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);
+ }
-
-FGRunway::FGRunway() {
+ 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() {
+// 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;
+ }
+
+ // 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(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);
}
-FGRunways::FGRunways( const string& file ) {
- // open the specified database readonly
- storage = new c4_Storage( file.c_str(), false );
+// search for the specified apt id (wierd!)
+bool FGRunwayList::search( const string& aptid, FGRunway* r ) {
+ runway_map_iterator pos;
- if ( !storage->Strategy().IsValid() ) {
- SG_LOG( SG_GENERAL, SG_ALERT, "Cannot open file: " << file );
- exit(-1);
+ pos = runways.lower_bound(aptid);
+ if ( pos != runways.end() ) {
+ current = pos;
+ *r = pos->second;
+ return true;
+ } else {
+ return false;
}
-
- vRunway = new c4_View;
- *vRunway =
- storage->GetAs("runway[ID:S,Rwy:S,Longitude:F,Latitude:F,Heading:F,Length:F,Width:F,SurfaceFlags:S,End1Flags:F,End2Flags:F]");
-
- next_index = 0;
}
-// search for the specified id
-bool FGRunways::search( const string& id, FGRunway* r ) {
- c4_StringProp pID ("ID");
- c4_StringProp pRwy ("Rwy");
- c4_FloatProp pLon ("Longitude");
- c4_FloatProp pLat ("Latitude");
- c4_FloatProp pHdg ("Heading");
- c4_FloatProp pLen ("Length");
- c4_FloatProp pWid ("Width");
- c4_StringProp pSurf ("SurfaceFlags");
- c4_StringProp pEnd1 ("End1Flags");
- c4_StringProp pEnd2 ("End2Flags");
-
- int index = vRunway->Find(pID[id.c_str()]);
- cout << "index = " << index << endl;
-
- if ( index == -1 ) {
- return false;
+// search for the specified apt id and runway no
+bool FGRunwayList::search( const string& aptid, const string& rwyno,
+ FGRunway *r )
+{
+ 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;
+ }
}
- next_index = index + 1;
-
- c4_RowRef row = vRunway->GetAt(index);
-
- r->id = (const char *) pID(row);
- r->rwy_no = (const char *) pRwy(row);
- r->lon = (double) pLon(row);
- r->lat = (double) pLat(row);
- r->heading = (double) pHdg(row);
- r->length = (double) pLen(row);
- r->width = (double) pWid(row);
- r->surface_flags = (const char *) pSurf(row);
- r->end1_flags = (const char *) pEnd1(row);
- r->end2_flags = (const char *) pEnd2(row);
-
- return true;
+ return false;
}
-FGRunway FGRunways::search( const string& id ) {
+// (wierd!)
+FGRunway FGRunwayList::search( const string& aptid ) {
FGRunway a;
- search( id, &a );
+ search( aptid, &a );
return a;
}
-// search for the specified id
-bool FGRunways::next( FGRunway* r ) {
- c4_StringProp pID ("ID");
- c4_StringProp pRwy ("Rwy");
- c4_FloatProp pLon ("Longitude");
- c4_FloatProp pLat ("Latitude");
- c4_FloatProp pHdg ("Heading");
- c4_FloatProp pLen ("Length");
- c4_FloatProp pWid ("Width");
- c4_StringProp pSurf ("SurfaceFlags");
- c4_StringProp pEnd1 ("End1Flags");
- c4_StringProp pEnd2 ("End2Flags");
-
- int size = vRunway->GetSize();
- // cout << "total records = " << size << endl;
-
- int index = next_index;
- // cout << "index = " << index << endl;
-
- if ( index == -1 || index >= size ) {
- return false;
- }
-
- next_index = index + 1;
-
- c4_RowRef row = vRunway->GetAt(index);
-
- r->id = (const char *) pID(row);
- r->rwy_no = (const char *) pRwy(row);
- r->lon = (double) pLon(row);
- r->lat = (double) pLat(row);
- r->heading = (double) pHdg(row);
- r->length = (double) pLen(row);
- r->width = (double) pWid(row);
- r->surface_flags = (const char *) pSurf(row);
- r->end1_flags = (const char *) pEnd1(row);
- r->end2_flags = (const char *) pEnd2(row);
-
- return true;
-}
-
-
-// Destructor
-FGRunways::~FGRunways( void ) {
- delete storage;
+// Return the runway closest to a given heading
+bool FGRunwayList::search( const string& aptid, const int tgt_hdg,
+ FGRunway *runway )
+{
+ string rwyNo = search(aptid, tgt_hdg);
+ return(rwyNo == "NN" ? false : search(aptid, rwyNo, runway));
}
-// Constructor
-FGRunwaysUtil::FGRunwaysUtil() {
-}
+// Return the runway number of the runway closest to a given heading
+string FGRunwayList::search( const string& aptid, const int hdg ) {
+ //SG_LOG(SG_GENERAL, SG_ALERT, "searching runway for " << aptid
+ // << " with target heading " << hdg);
-
-// load the data
-int FGRunwaysUtil::load( const string& file ) {
FGRunway r;
- string apt_id;
-
- runways.erase( runways.begin(), runways.end() );
-
- fg_gzifstream in( file );
- if ( !in.is_open() ) {
- SG_LOG( SG_GENERAL, SG_ALERT, "Cannot open file: " << file );
- exit(-1);
- }
-
- // skip first line of file
- char tmp[256];
- in.getline( tmp, 256 );
-
- // read in each line of the file
-
-#ifdef __MWERKS__
-
- in >> ::skipws;
- char c = 0;
- while ( in.get(c) && c != '\0' ) {
- if ( c == 'A' ) {
- in >> apt_id;
- in >> skipeol;
- } else if ( c == 'R' ) {
- in >> r;
- r.id = apt_id;
- runways.push_back(r);
- } else {
- in >> skipeol;
- }
- in >> ::skipws;
- }
-
-#else
-
- in >> ::skipws;
- while ( ! in.eof() ) {
- char c = 0;
- in.get(c);
- if ( c == 'A' ) {
- in >> apt_id;
- in >> skipeol;
- } else if ( c == 'R' ) {
- in >> r;
- r.id = apt_id;
- // cout << apt_id << " " << r.rwy_no << endl;
- runways.push_back(r);
- } else {
- in >> skipeol;
- }
- in >> ::skipws;
+ if (!search(aptid, &r)) {
+ SG_LOG(SG_GENERAL, SG_ALERT, "Failed to find "
+ << aptid << " in database.");
+ return "NN";
}
-#endif
-
- return 1;
+ SGPropertyNode *param = fgGetNode("/sim/airport/runways/search", true);
+ double lenwgt = param->getDoubleValue("length-weight", 0.01);
+ double widwgt = param->getDoubleValue("width-weight", 0.01);
+ double surfwgt = param->getDoubleValue("surface-weight", 10);
+ double devwgt = param->getDoubleValue("deviation-weight", 1);
+
+ FGRunway best;
+ double max = 0.0;
+ bool reversed = false;
+
+ do {
+ if (r._id != aptid)
+ break;
+ if (r._type != "runway")
+ continue;
+
+ int surface = 1;
+ if (r._surface_code == 12 || r._surface_code == 5) // dry lakebed & gravel
+ surface = 2;
+ else if (r._surface_code == 1 || r._surface_code == 2) // asphalt & concrete
+ surface = 3;
+
+ double quality, bad, diff;
+ double good = lenwgt * r._length + widwgt * r._width + surfwgt * surface + 1e-20;
+
+ // this side
+ diff = hdg - r._heading;
+ while (diff < -180)
+ diff += 360;
+ while (diff >= 180)
+ diff -= 360;
+ bad = fabs(devwgt * diff) + 1e-20;
+
+ quality = good / bad;
+ //SG_LOG(SG_GENERAL, SG_ALERT, " 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 = fabs(devwgt * diff) + 1e-20;
+
+ quality = good / bad;
+ //SG_LOG(SG_GENERAL, SG_ALERT, " runway " << GetReverseRunwayNo(r._rwy_no)
+ // << " -> " << quality);
+ if (quality > max) {
+ max = quality;
+ best = r;
+ reversed = true;
+ }
+
+ } while (next(&r));
+
+ return reversed ? GetReverseRunwayNo(best._rwy_no) : best._rwy_no;
}
-// save the data in gdbm format
-bool FGRunwaysUtil::dump_mk4( const string& file ) {
-
- // open database for writing
- c4_Storage storage( file.c_str(), true );
-
- // need to do something about error handling here!
-
- // define the properties
- c4_StringProp pID ("ID");
- c4_StringProp pRwy ("Rwy");
- c4_FloatProp pLon ("Longitude");
- c4_FloatProp pLat ("Latitude");
- c4_FloatProp pHdg ("Heading");
- c4_FloatProp pLen ("Length");
- c4_FloatProp pWid ("Width");
- c4_StringProp pSurf ("SurfaceFlags");
- c4_StringProp pEnd1 ("End1Flags");
- c4_StringProp pEnd2 ("End2Flags");
-
- // Start with an empty view of the proper structure.
- c4_View vRunway =
- storage.GetAs("runway[ID:S,Rwy:S,Longitude:F,Latitude:F,Heading:F,Length:F,Width:F,SurfaceFlags:S,End1Flags:F,End2Flags:F]");
-
- c4_Row row;
-
- iterator current = runways.begin();
- const_iterator end = runways.end();
- while ( current != end ) {
- // add each runway record
- pID (row) = current->id.c_str();
- pRwy (row) = current->rwy_no.c_str();
- pLon (row) = current->lon;
- pLat (row) = current->lat;
- pHdg (row) = current->heading;
- pLen (row) = current->length;
- pWid (row) = current->width;
- pSurf (row) = current->surface_flags.c_str();
- pEnd1 (row) = current->end1_flags.c_str();
- pEnd2 (row) = current->end2_flags.c_str();
- vRunway.Add(row);
-
- ++current;
+bool FGRunwayList::next( FGRunway* runway ) {
+ ++current;
+ if ( current != runways.end() ) {
+ *runway = current->second;
+ return true;
+ } else {
+ return false;
}
-
- // commit our changes
- storage.Commit();
-
- return true;
}
-#if 0
-// search for the specified id
-bool
-FGRunwaysUtil::search( const string& id, FGRunway* a ) const
-{
- const_iterator it = runways.find( FGRunway(id) );
- if ( it != runways.end() )
- {
- *a = *it;
- return true;
- }
- else
- {
- return false;
- }
-}
+FGRunway FGRunwayList::next() {
+ FGRunway result;
+ ++current;
+ if ( current != runways.end() ) {
+ result = current->second;
+ }
-FGRunway
-FGRunwaysUtil::search( const string& id ) const
-{
- FGRunway a;
- this->search( id, &a );
- return a;
+ return result;
}
-#endif
+
// Destructor
-FGRunwaysUtil::~FGRunwaysUtil( void ) {
+FGRunwayList::~FGRunwayList( void ) {
}
-
-
projects / flightgear.git / blobdiff