#include <simgear/compiler.h>
#include <simgear/math/sg_geodesy.hxx>
-#include <simgear/misc/fgstream.hxx>
+#include <simgear/misc/sgstream.hxx>
#include <simgear/magvar/magvar.hxx>
#include <simgear/timing/sg_time.hxx>
-#ifdef FG_HAVE_STD_INCLUDES
+#ifdef SG_HAVE_STD_INCLUDES
# include <istream>
-#elif defined( FG_HAVE_NATIVE_SGI_COMPILERS )
-# include <iostream.h>
-#elif defined( __BORLANDC__ )
+#elif defined( __BORLANDC__ ) || (__APPLE__)
# include <iostream>
#else
# include <istream.h>
#endif
-#if ! defined( FG_HAVE_NATIVE_SGI_COMPILERS )
-FG_USING_STD(istream);
-#endif
+SG_USING_STD(istream);
class FGNav {
string ident; // to avoid a core dump with corrupt data
double magvar; // magvar from true north (negative = W)
+ // for failure modeling
+ string trans_ident; // transmitted ident
+ bool nav_failed; // nav failed?
+ bool dme_failed; // dme failed?
+
public:
- inline FGNav(void) {}
+ inline FGNav(void);
inline ~FGNav(void) {}
inline char get_type() const { return type; }
inline int get_range() const { return range; }
inline bool get_has_dme() const { return has_dme; }
inline const char *get_ident() { return ident.c_str(); }
+ inline string get_trans_ident() { return trans_ident; }
inline double get_magvar () const { return magvar; }
- /* 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 ); } */
-
friend istream& operator>> ( istream&, FGNav& );
};
+inline
+FGNav::FGNav(void) :
+ type(0),
+ lon(0.0), lat(0.0),
+ elev(0.0),
+ x(0.0), y(0.0), z(0.0),
+ freq(0),
+ range(0),
+ has_dme(false),
+ ident(""),
+ magvar(0.0),
+ trans_ident(""),
+ nav_failed(false),
+ dme_failed(false)
+{
+}
+
+
inline istream&
operator >> ( istream& in, FGNav& n )
{
char c /* , magvar_dir */ ;
string magvar_s;
- static SGTime time_params;
static bool first_time = true;
static double julian_date = 0;
+ static const double MJD0 = 2415020.0;
if ( first_time ) {
- time_params.update( 0.0, 0.0, 0 );
- julian_date = time_params.getJD();
+ julian_date = sgTimeCurrentMJD(0,0) + MJD0;
first_time = false;
}
- in >> n.type >> n.lat >> n.lon >> n.elev >> f >> n.range
+ in >> n.type;
+
+ if ( n.type == '[' )
+ return in >> skipeol;
+
+ in >> n.lat >> n.lon >> n.elev >> f >> n.range
>> c >> n.ident >> magvar_s;
n.freq = (int)(f*100.0 + 0.5);
// cout << "lat = " << n.lat << " lon = " << n.lon << " elev = "
// << n.elev << " JD = "
// << julian_date << endl;
- n.magvar = sgGetMagVar(n.lon * DEG_TO_RAD, n.lat * DEG_TO_RAD,
- n.elev * FEET_TO_METER,
- julian_date) * RAD_TO_DEG;
+ n.magvar = sgGetMagVar( n.lon * SGD_DEGREES_TO_RADIANS,
+ n.lat * SGD_DEGREES_TO_RADIANS,
+ n.elev * SG_FEET_TO_METER,
+ julian_date )
+ * SGD_RADIANS_TO_DEGREES;
// cout << "Default variation at " << n.lon << ',' << n.lat
// << " is " << var << endl;
#if 0
int var;
sscanf(magvar_s.c_str(), "%d%c", &var, &direction);
n.magvar = var;
- if (direction == 'E')
- n.magvar = 0 - n.magvar;
+ if (direction == 'W')
+ n.magvar = -n.magvar;
// cout << "Explicit magvar of " << n.magvar << endl;
}
// cout << n.ident << " " << n.magvar << endl;
// generate cartesian coordinates
- Point3D geod( n.lon * DEG_TO_RAD, n.lat * DEG_TO_RAD, n.elev );
+ Point3D geod( n.lon * SGD_DEGREES_TO_RADIANS, n.lat * SGD_DEGREES_TO_RADIANS, n.elev );
Point3D cart = sgGeodToCart( geod );
n.x = cart.x();
n.y = cart.y();
n.z = cart.z();
+ n.trans_ident = n.ident;
+ n.nav_failed = n.dme_failed = false;
+
return in >> skipeol;
}