noinst_PROGRAMS = testnavs
-libNavAids_a_SOURCES = nav.hxx navlist.hxx navlist.cxx
+libNavAids_a_SOURCES = \
+ ils.hxx ilslist.hxx ilslist.cxx \
+ nav.hxx navlist.hxx navlist.cxx
testnavs_SOURCES = testnavs.cxx
testnavs_LDADD = libNavAids.a -lsgdebug -lsgmath -lsgmisc -lz
--- /dev/null
+// ils.hxx -- navaid class
+//
+// Written by Curtis Olson, started April 2000.
+//
+// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org
+//
+// 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., 675 Mass Ave, Cambridge, MA 02139, USA.
+//
+// $Id$
+
+
+#ifndef _FG_ILS_HXX
+#define _FG_ILS_HXX
+
+
+#include <simgear/compiler.h>
+#include <simgear/misc/fgstream.hxx>
+
+#ifdef FG_HAVE_STD_INCLUDES
+# include <istream>
+#elif defined( FG_HAVE_NATIVE_SGI_COMPILERS )
+# include <iostream.h>
+#elif defined( __BORLANDC__ )
+# include <iostream>
+#else
+# include <istream.h>
+#endif
+
+#if ! defined( FG_HAVE_NATIVE_SGI_COMPILERS )
+FG_USING_STD(istream);
+#endif
+
+
+#define FG_ILS_DEFAULT_RANGE 30
+
+class FGILS {
+
+ char ilstype;
+ char ilstypename[6];
+ char aptcode[5];
+ char rwyno[4];
+ int locfreq;
+ char locident[5];
+ double locheading;
+ double loclat;
+ double loclon;
+ double gselev;
+ double gsangle;
+ double gslat;
+ double gslon;
+ double dmelat;
+ double dmelon;
+ double omlat;
+ double omlon;
+ double mmlat;
+ double mmlon;
+ double imlat;
+ double imlon;
+
+public:
+
+ inline FGILS(void) {}
+ inline ~FGILS(void) {}
+
+ inline char get_ilstype() const { return ilstype; }
+ inline char *get_ilstypename() { return ilstypename; }
+ inline char *get_aptcode() { return aptcode; }
+ inline char *get_rwyno() { return rwyno; }
+ inline int get_locfreq() const { return locfreq; }
+ inline char *get_locident() { return locident; }
+ inline double get_locheading() const { return locheading; }
+ inline double get_loclat() const { return loclat; }
+ inline double get_loclon() const { return loclon; }
+ inline double get_gsangle() const { return gsangle; }
+ inline double get_gslat() const { return gslat; }
+ inline double get_gslon() const { return gslon; }
+ inline double get_dmelat() const { return dmelat; }
+ inline double get_dmelon() const { return dmelon; }
+ inline double get_omlat() const { return omlat; }
+ inline double get_omlon() const { return omlon; }
+ inline double get_mmlat() const { return mmlat; }
+ inline double get_mmlon() const { return mmlon; }
+ inline double get_imlat() const { return imlat; }
+ inline double get_imlon() const { return imlon; }
+
+ friend istream& operator>> ( istream&, FGILS& );
+};
+
+
+inline istream&
+operator >> ( istream& in, FGILS& i )
+{
+ double f;
+ in >> i.ilstype >> i.ilstypename >> i.aptcode >> i.rwyno
+ >> f >> i.locident >> i.locheading >> i.loclat >> i.loclon
+ >> i.gselev >> i.gsangle >> i.gslat >> i.gslon
+ >> i.dmelat >> i.dmelon
+ >> i.omlat >> i.omlon
+ >> i.mmlat >> i.mmlon
+ >> i.imlat >> i.imlon;
+
+
+ i.locfreq = (int)(f * 100.0);
+
+ // return in >> skipeol;
+ return in;
+}
+
+
+#endif // _FG_NAVAID_HXX
--- /dev/null
+// ilslist.cxx -- ils management class
+//
+// Written by Curtis Olson, started April 2000.
+//
+// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org
+//
+// 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., 675 Mass Ave, Cambridge, MA 02139, USA.
+//
+// $Id$
+
+
+#include <simgear/debug/logstream.hxx>
+#include <simgear/misc/fgstream.hxx>
+#include <simgear/math/fg_geodesy.hxx>
+
+#include "ilslist.hxx"
+
+
+// Constructor
+FGILSList::FGILSList( void ) {
+}
+
+
+// Destructor
+FGILSList::~FGILSList( void ) {
+}
+
+
+// load the navaids and build the map
+bool FGILSList::init( FGPath path ) {
+ FGILS ils;
+
+ ilslist.erase( ilslist.begin(), ilslist.end() );
+
+ fg_gzifstream in( path.str() );
+ if ( !in.is_open() ) {
+ FG_LOG( FG_GENERAL, FG_ALERT, "Cannot open file: " << path.str() );
+ exit(-1);
+ }
+
+ // read in each line of the file
+
+ in >> skipeol;
+ in >> skipcomment;
+
+#ifdef __MWERKS__
+
+ char c = 0;
+ while ( in.get(c) && c != '\0' && n.get_ilstype() != '[' ) {
+ in.putback(c);
+ in >> ils;
+ if ( ils.get_type() != '[' ) {
+ ilslist[ils.get_locfreq()].push_back(ils);
+ }
+ in >> skipcomment;
+ }
+
+#else
+
+ while ( ! in.eof() && ils.get_ilstype() != '[' ) {
+ in >> ils;
+ /* 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 ( ils.get_ilstype() != '[' ) {
+ ilslist[ils.get_locfreq()].push_back(ils);
+ }
+ in >> skipcomment;
+ }
+
+#endif
+
+ return true;
+}
+
+
+// query the database for the specified frequency, lon and lat are in
+// degrees, elev is in meters
+bool FGILSList::query( double lon, double lat, double elev, double freq,
+ FGILS *ils, double *heading, double *dist )
+{
+ ils_list_type stations = ilslist[(int)(freq*100.0)];
+
+ ils_list_iterator current = stations.begin();
+ ils_list_iterator last = stations.end();
+
+ double az1, az2, s;
+ for ( ; current != last ; ++current ) {
+ // cout << "testing " << current->get_ident() << endl;
+ geo_inverse_wgs_84( elev, lat, lon,
+ current->get_loclat(), current->get_loclon(),
+ &az1, &az2, &s );
+ // cout << " dist = " << s << endl;
+ if ( s < ( FG_ILS_DEFAULT_RANGE * NM_TO_METER ) ) {
+ *ils = *current;
+ *heading = az2;
+ *dist = s;
+ return true;
+ }
+ }
+
+ return false;
+}
--- /dev/null
+// ilslist.hxx -- ils management class
+//
+// Written by Curtis Olson, started April 2000.
+//
+// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org
+//
+// 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., 675 Mass Ave, Cambridge, MA 02139, USA.
+//
+// $Id$
+
+
+#ifndef _FG_ILSLIST_HXX
+#define _FG_ILSLIST_HXX
+
+
+#include <simgear/compiler.h>
+#include <simgear/misc/fgpath.hxx>
+
+#include <map>
+#include <vector>
+
+#include "ils.hxx"
+
+FG_USING_STD(map);
+FG_USING_STD(vector);
+
+
+class FGILSList {
+
+ // convenience types
+ typedef vector < FGILS > ils_list_type;
+ typedef ils_list_type::iterator ils_list_iterator;
+ typedef ils_list_type::const_iterator ils_list_const_iterator;
+
+ typedef map < int, ils_list_type, less<int> > ils_map_type;
+ typedef ils_map_type::iterator ils_map_iterator;
+ typedef ils_map_type::const_iterator ils_map_const_iterator;
+
+ ils_map_type ilslist;
+
+public:
+
+ FGILSList();
+ ~FGILSList();
+
+ // load the navaids and build the map
+ bool init( FGPath path );
+
+ // query the database for the specified frequency, lon and lat are
+ // in degrees, elev is in meters
+ bool query( double lon, double lat, double elev, double freq,
+ FGILS *i, double *heading, double *dist);
+};
+
+
+#endif // _FG_ILSLIST_HXX
inline bool get_dme() const { return dme; }
inline char *get_ident() { return ident; }
- inline void set_type( char t ) { type = t; }
+ /* inline void set_type( char t ) { type = t; }
inline void set_lon( double l ) { lon = l; }
inline void set_lat( double l ) { lat = l; }
inline void set_elev( double e ) { elev = e; }
inline void set_freq( int f ) { freq = f; }
inline void set_range( int r ) { range = r; }
inline void set_dme( bool b ) { dme = b; }
- inline void set_ident( char *i ) { strncpy( ident, i, 5 ); }
+ inline void set_ident( char *i ) { strncpy( ident, i, 5 ); } */
friend istream& operator>> ( istream&, FGNav& );
};
#include <simgear/misc/fgpath.hxx>
+#include "ilslist.hxx"
#include "navlist.hxx"
int main() {
- FGNavList navs;
-
- FGPath p( "/export/data2/curt/FlightGear/Navaids/default.nav" );
-
- navs.init( p );
+ double heading, dist;
+ FGNavList navs;
+ FGPath p_nav( "/home/curt/FlightGear/Navaids/default.nav" );
+ navs.init( p_nav );
FGNav n;
- double heading, dist;
if ( navs.query( -93.2, 45.14, 3000, 117.30,
&n, &heading, &dist) ) {
- cout << "Found a station in range" << endl;
+ cout << "Found a vor station in range" << endl;
cout << " id = " << n.get_ident() << endl;
cout << " heading = " << heading << " dist = " << dist << endl;
} else {
- cout << "not picking anything up. :-(" << endl;
+ cout << "not picking up vor. :-(" << endl;
+ }
+
+ FGILSList ilslist;
+ FGPath p_ils( "/home/curt/FlightGear/Navaids/default.ils" );
+ ilslist.init( p_ils );
+ FGILS i;
+ if ( ilslist.query( -93.1, 45.24, 3000, 110.30,
+ &i, &heading, &dist) ) {
+ cout << "Found an ils station in range" << endl;
+ cout << " apt = " << i.get_aptcode() << endl;
+ cout << " rwy = " << i.get_rwyno() << endl;
+ cout << " heading = " << heading << " dist = " << dist << endl;
+ } else {
+ cout << "not picking up ils. :-(" << endl;
}
}
projects / flightgear.git / commitdiff