1 // nav.hxx -- vor/dme/ndb class
3 // Written by Curtis Olson, started April 2000.
5 // Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org
7 // This program is free software; you can redistribute it and/or
8 // modify it under the terms of the GNU General Public License as
9 // published by the Free Software Foundation; either version 2 of the
10 // License, or (at your option) any later version.
12 // This program is distributed in the hope that it will be useful, but
13 // WITHOUT ANY WARRANTY; without even the implied warranty of
14 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 // General Public License for more details.
17 // You should have received a copy of the GNU General Public License
18 // along with this program; if not, write to the Free Software
19 // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
29 #include <simgear/compiler.h>
30 #include <simgear/math/sg_geodesy.hxx>
31 #include <simgear/misc/sgstream.hxx>
32 #include <simgear/magvar/magvar.hxx>
33 #include <simgear/timing/sg_time.hxx>
35 #ifdef SG_HAVE_STD_INCLUDES
37 #elif defined( SG_HAVE_NATIVE_SGI_COMPILERS )
38 # include <iostream.h>
39 #elif defined( __BORLANDC__ )
45 #if ! defined( SG_HAVE_NATIVE_SGI_COMPILERS )
46 SG_USING_STD(istream);
59 string ident; // to avoid a core dump with corrupt data
60 double magvar; // magvar from true north (negative = W)
62 // for failure modeling
63 string trans_ident; // transmitted ident
64 bool nav_failed; // nav failed?
65 bool dme_failed; // dme failed?
70 inline ~FGNav(void) {}
72 inline char get_type() const { return type; }
73 inline double get_lon() const { return lon; }
74 inline double get_lat() const { return lat; }
75 inline double get_elev() const { return elev; }
76 inline double get_x() const { return x; }
77 inline double get_y() const { return y; }
78 inline double get_z() const { return z; }
79 inline int get_freq() const { return freq; }
80 inline int get_range() const { return range; }
81 inline bool get_has_dme() const { return has_dme; }
82 inline const char *get_ident() { return ident.c_str(); }
83 inline string get_trans_ident() { return trans_ident; }
84 inline double get_magvar () const { return magvar; }
86 /* inline void set_type( char t ) { type = t; }
87 inline void set_lon( double l ) { lon = l; }
88 inline void set_lat( double l ) { lat = l; }
89 inline void set_elev( double e ) { elev = e; }
90 inline void set_freq( int f ) { freq = f; }
91 inline void set_range( int r ) { range = r; }
92 inline void set_dme( bool b ) { dme = b; }
93 inline void set_ident( char *i ) { strncpy( ident, i, 5 ); } */
95 friend istream& operator>> ( istream&, FGNav& );
100 operator >> ( istream& in, FGNav& n )
103 char c /* , magvar_dir */ ;
106 static SGTime time_params;
107 static bool first_time = true;
108 static double julian_date = 0;
110 time_params.update( 0.0, 0.0, 0 );
111 julian_date = time_params.getJD();
115 in >> n.type >> n.lat >> n.lon >> n.elev >> f >> n.range
116 >> c >> n.ident >> magvar_s;
118 n.freq = (int)(f*100.0 + 0.5);
125 // Calculate the magvar from true north.
126 // cout << "Calculating magvar for navaid " << n.ident << endl;
127 if (magvar_s == "XXX") {
128 // default to mag var as of 1990-01-01 (Julian 2447892.5)
129 // cout << "lat = " << n.lat << " lon = " << n.lon << " elev = "
130 // << n.elev << " JD = "
131 // << julian_date << endl;
132 n.magvar = sgGetMagVar(n.lon * SGD_DEGREES_TO_RADIANS, n.lat * SGD_DEGREES_TO_RADIANS,
133 n.elev * SG_FEET_TO_METER,
134 julian_date) * SGD_RADIANS_TO_DEGREES;
135 // cout << "Default variation at " << n.lon << ',' << n.lat
136 // << " is " << var << endl;
138 // I don't know what this is for - CLO 1 Feb 2001
139 if (var - int(var) >= 0.5)
140 n.magvar = int(var) + 1;
141 else if (var - int(var) <= -0.5)
142 n.magvar = int(var) - 1;
146 // cout << "Defaulted to magvar of " << n.magvar << endl;
150 sscanf(magvar_s.c_str(), "%d%c", &var, &direction);
152 if (direction == 'W')
153 n.magvar = -n.magvar;
154 // cout << "Explicit magvar of " << n.magvar << endl;
156 // cout << n.ident << " " << n.magvar << endl;
158 // generate cartesian coordinates
159 Point3D geod( n.lon * SGD_DEGREES_TO_RADIANS, n.lat * SGD_DEGREES_TO_RADIANS, n.elev );
160 Point3D cart = sgGeodToCart( geod );
165 n.trans_ident = n.ident;
166 n.nav_failed = n.dme_failed = false;
168 return in >> skipeol;
172 #endif // _FG_NAV_HXX