3842fa0edc
Attached patch adds support for multiple FIXes with the same name. Applies to both branches. New functionality is in query_and_offset, which now returns the FIX closest to the passed in location. Updated route manager to take advantage of this. Otherwise, query functions return an unspecified member from the set of identically named FIXes. (This was previously the one occurring last in the database file, but I don't think anybody counted on that.)
143 lines
3.7 KiB
C++
143 lines
3.7 KiB
C++
// fixlist.cxx -- fix list management class
|
|
//
|
|
// Written by Curtis Olson, started April 2000.
|
|
//
|
|
// 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
|
|
// published by the Free Software Foundation; either version 2 of the
|
|
// License, or (at your option) any later version.
|
|
//
|
|
// This program is distributed in the hope that it will be useful, but
|
|
// WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
// General Public License for more details.
|
|
//
|
|
// 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., 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"
|
|
SG_USING_STD(pair);
|
|
|
|
|
|
// Constructor
|
|
FGFixList::FGFixList( void ) {
|
|
}
|
|
|
|
|
|
// Destructor
|
|
FGFixList::~FGFixList( void ) {
|
|
}
|
|
|
|
|
|
// load the navaids and build the map
|
|
bool FGFixList::init( SGPath path ) {
|
|
fixlist.erase( fixlist.begin(), fixlist.end() );
|
|
|
|
sg_gzifstream in( path.str() );
|
|
if ( !in.is_open() ) {
|
|
SG_LOG( SG_GENERAL, SG_ALERT, "Cannot open file: " << path.str() );
|
|
exit(-1);
|
|
}
|
|
|
|
// toss the first two lines of the file
|
|
in >> skipeol;
|
|
in >> skipeol;
|
|
|
|
// read in each remaining line of the file
|
|
|
|
#ifdef __MWERKS__
|
|
char c = 0;
|
|
while ( in.get(c) && c != '\0' ) {
|
|
in.putback(c);
|
|
#else
|
|
while ( ! in.eof() ) {
|
|
#endif
|
|
|
|
FGFix fix;
|
|
in >> fix;
|
|
if ( fix.get_lat() > 95.0 ) {
|
|
break;
|
|
}
|
|
|
|
/* cout << "ident=" << fix.get_ident()
|
|
<< ", lat=" << fix.get_lat()
|
|
<< ", lon=" << fix.get_lon() << endl; */
|
|
|
|
fixlist.insert(pair<string, FGFix>(fix.get_ident(), fix));
|
|
in >> skipcomment;
|
|
}
|
|
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 fix, lon and lat are in
|
|
// degrees, elev is in meters
|
|
bool FGFixList::query_and_offset( const string& ident, double lon, double lat,
|
|
double elev, FGFix *fix, double *heading,
|
|
double *dist )
|
|
{
|
|
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;
|
|
}
|
|
}
|
|
|
|
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));
|
|
}
|
|
}
|