Merge /u/r-harrison/flightgear/ branch next into next

[flightgear.git] / src / Navaids / testnavs.cxx

diff --git a/src/Navaids/testnavs.cxx b/src/Navaids/testnavs.cxx
index 1a2e3dcfd808cb24092c13187f4e35755056fe11..d38341aa7305e3f939e17fb511d0b2ee5852596a 100644 (file)
--- a/src/Navaids/testnavs.cxx
+++ b/src/Navaids/testnavs.cxx
@@ -1,48 +1,99 @@
-#include <simgear/misc/fgpath.hxx>
+// Written by James Turner, started 2009.
+//
+// Copyright (C) 2009  Curtis L. Olson
+//
+// 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.
+
+#include <simgear/misc/sg_path.hxx>
 
 #include "fixlist.hxx"
 #include "ilslist.hxx"
 #include "navlist.hxx"
+#include "mkrbeacons.hxx"
+
+// change this!
+const string FG_DATA_DIR("/usr/local/lib/FlightGear");
 
 int main() {
     double heading, dist;
 
-    FGNavList navs;
-    FGPath p_nav( "/home/curt/FlightGear/Navaids/default.nav" );
-    navs.init( p_nav );
-    FGNav n;
-    if ( navs.query( -93.2, 45.14, 3000, 117.30,
-                    &n, &heading, &dist) ) {
+    FGNavList *current_navlist = new FGNavList;
+    SGPath p_nav( FG_DATA_DIR + "/Navaids/default.nav" );
+
+    current_navlist->init( p_nav );
+       
+    FGNavRecord *n;
+    if ( (n = current_navlist->findByFreq( -93.2 * SG_DEGREES_TO_RADIANS,
+                                           45.14 * SG_DEGREES_TO_RADIANS,
+                                           3000, 117.30)) != NULL )
+    {
        cout << "Found a vor station in range" << endl;
-       cout << " id = " << n.get_ident() << endl;
-       cout << " heading = " << heading << " dist = " << dist << endl;
+       cout << " id = " << n->get_ident() << endl;
     } else {
        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) ) {
+    FGNavRecord *dcs;
+    if ( (dcs = current_navlist->findByIdent( "DCS",
+                                              -3.3 * SG_DEGREES_TO_RADIANS,
+                                              55.9 * SG_DEGREES_TO_RADIANS))
+         != NULL ) {
+                                               
+        cout << "Found DCS by ident" << endl;
+        if (dcs->get_freq() != 11520)
+            cout << "Frequency for DCS VOR is wrong (should be 115.20), it's " 
+                 << dcs->get_freq() << endl;
+    } else {
+        cout << "couldn't locate DCS (Dean-Cross) VOR" << endl;
+    }
+       
+    // we have to init the marker beacon storage before we parse the ILS file
+    FGMarkerBeacons *current_beacons = new FGMarkerBeacons;
+    current_beacons->init();
+       
+    FGILSList *current_ilslist = new FGILSList;
+    SGPath p_ils( FG_DATA_DIR + "/Navaids/default.ils" );
+    current_ilslist->init( p_ils );
+    FGILS *i = current_ilslist->findByFreq( -93.1 * SG_DEGREES_TO_RADIANS,
+                                            45.24 * SG_DEGREES_TO_RADIANS,
+                                            3000, 110.30);
+    if ( i != NULL ) {
        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;
+       cout << " apt = " << i->get_aptcode() << endl;
+       cout << " rwy = " << i->get_rwyno() << endl;
     } else {
        cout << "not picking up ils. :-(" << endl;
     }
 
-    FGFixList fixlist;
-    FGPath p_fix( "/home/curt/FlightGear/Navaids/default.fix" );
-    fixlist.init( p_fix );
+    FGFixList *current_fixlist = new FGFixList;
+    SGPath p_fix( FG_DATA_DIR + "/Navaids/default.fix" );
+    current_fixlist->init( p_fix );
     FGFix fix;
-    if ( fixlist.query( "GONER", -82, 41, 3000,
-                       &fix, &heading, &dist) ) {
+       
+    // attempting to get the position relative to the OTR VOR; heading
+    // should be 108 degrees, distance 74nm (according to my SimCharts
+    // v1.5)
+    if ( current_fixlist->query_and_offset( "DOGGA",
+                                            -0.103 * SG_DEGREES_TO_RADIANS,
+                                            53.698 * SG_DEGREES_TO_RADIANS,
+                                            3000, &fix, &heading, &dist) )
+    {
        cout << "Found a matching fix" << endl;
        cout << " id = " << fix.get_ident() << endl;
-       cout << " heading = " << heading << " dist = " << dist << endl;
+       cout << " heading = " << heading << " dist = " << dist * SG_METER_TO_NM
+             << endl;
     } else {
        cout << "did not find fix. :-(" << endl;
     }