//
// Written by Curtis Olson, started April 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$
+#ifdef HAVE_CONFIG_H
+# include <config.h>
+#endif
+
#include <simgear/debug/logstream.hxx>
#include <simgear/misc/sgstream.hxx>
#include <simgear/math/sg_geodesy.hxx>
#include "fixlist.hxx"
-
-
-FGFixList *current_fixlist;
+SG_USING_STD(pair);
// Constructor
// load the navaids and build the map
bool FGFixList::init( SGPath path ) {
- FGFix fix;
-
fixlist.erase( fixlist.begin(), fixlist.end() );
sg_gzifstream in( path.str() );
exit(-1);
}
- // read in each line of the file
-
+ // toss the first two lines of the file
+ in >> skipeol;
in >> skipeol;
- in >> skipcomment;
-#ifdef __MWERKS__
+ // read in each remaining line of the file
+#ifdef __MWERKS__
char c = 0;
- while ( in.get(c) && c != '\0' && fix.get_ident() != "[End]" ) {
+ while ( in.get(c) && c != '\0' ) {
in.putback(c);
+#else
+ while ( ! in.eof() ) {
+#endif
+
+ FGFix fix;
in >> fix;
- if ( fix.get_ident() != "[End]" ) {
- fixlist[fix.get_ident()] = fix;
- }
- in >> skipcomment;
- }
+ if ( fix.get_lat() > 95.0 ) {
+ break;
+ }
-#else
+ /* cout << "ident=" << fix.get_ident()
+ << ", lat=" << fix.get_lat()
+ << ", lon=" << fix.get_lon() << endl; */
- while ( ! in.eof() && fix.get_ident() != "[End]" ) {
- in >> fix;
- /* cout << "id = " << n.get_ident() << endl;
- cout << " type = " << n.get_type() << endl;
- cout << " lon = " << n.get_lon() << endl;
- cout << " lat = " << n.get_lat() << endl;
- cout << " elev = " << n.get_elev() << endl;
- cout << " freq = " << n.get_freq() << endl;
- cout << " range = " << n.get_range() << endl; */
- if ( fix.get_ident() != "[End]" ) {
- fixlist[fix.get_ident()] = fix;
- }
+ fixlist.insert(pair<string, FGFix>(fix.get_ident(), fix));
in >> skipcomment;
}
+ return true;
+}
-#endif
- return true;
+// query the database for the specified fix, lon and lat are in
+// degrees, elev is in meters
+bool FGFixList::query( const string& ident, FGFix *fix ) {
+ fix_map_const_iterator it = fixlist.find(ident);
+ if ( it != fixlist.end() ) {
+ *fix = it->second;
+ return true;
+ } else {
+ return false;
+ }
}
-// query the database for the specified frequency, lon and lat are in
+// query the database for the specified fix, lon and lat are in
// degrees, elev is in meters
-bool FGFixList::query( const string& ident, double lon, double lat, double elev,
- FGFix *fix, double *heading, double *dist )
+bool FGFixList::query_and_offset( const string& ident, double lon, double lat,
+ double elev, FGFix *fix, double *heading,
+ double *dist )
{
- *fix = fixlist[ident];
- if ( fix->get_ident() == "" ) {
- return false;
+ pair<fix_map_const_iterator, fix_map_const_iterator> range = fixlist.equal_range(ident);
+
+ if (range.first == range.second) {
+ return false;
+ }
+
+ double min_s = -1.0;
+ for (fix_map_const_iterator current = range.first; current != range.second; ++current) {
+ double az1, az2, s;
+ geo_inverse_wgs_84( elev, lat, lon,
+ current->second.get_lat(), current->second.get_lon(),
+ &az1, &az2, &s );
+ // cout << " dist = " << s << endl;
+ if (min_s < 0 || s < min_s) {
+ *heading = az2;
+ *dist = s;
+ min_s = s;
+ *fix = current->second;
+ }
}
- double az1, az2, s;
- geo_inverse_wgs_84( elev, lat, lon,
- fix->get_lat(), fix->get_lon(),
- &az1, &az2, &s );
- // cout << " dist = " << s << endl;
- *heading = az2;
- *dist = s;
return true;
}
+
+const FGFix* FGFixList::findFirstByIdent( const string& ident, bool exact)
+{
+ fix_map_iterator itr;
+ if(exact) {
+ itr = fixlist.find(ident);
+ } else {
+ itr = fixlist.lower_bound(ident);
+ }
+ if(itr == fixlist.end()) {
+ return(NULL);
+ } else {
+ return(&(itr->second));
+ }
+}