src/Instrumentation/navradio.hxx

   1 // navradio.hxx -- class to manage a nav radio instance
   2 //
   3 // Written by Curtis Olson, started April 2000.
   4 //
   5 // Copyright (C) 2000 - 2002  Curtis L. Olson - http://www.flightgear.org/~curt
   6 //
   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.
  11 //
  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.
  16 //
  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.
  20 //
  21 // $Id$
  22
  23
  24 #ifndef _FG_NAVRADIO_HXX
  25 #define _FG_NAVRADIO_HXX
  26
  27
  28 #include <Main/fg_props.hxx>
  29
  30 #include <simgear/compiler.h>
  31 #include <simgear/structure/subsystem_mgr.hxx>
  32 #include <simgear/math/interpolater.hxx>
  33 #include <simgear/timing/timestamp.hxx>
  34
  35 #include <Navaids/navlist.hxx>
  36 #include <Sound/morse.hxx>
  37
  38 class FGNavRadio : public SGSubsystem
  39 {
  40     FGMorse morse;
  41
  42     SGInterpTable *term_tbl;
  43     SGInterpTable *low_tbl;
  44     SGInterpTable *high_tbl;
  45
  46     SGPropertyNode *lon_node;
  47     SGPropertyNode *lat_node;
  48     SGPropertyNode *alt_node;
  49     SGPropertyNode *bus_power;
  50     SGPropertyNode *nav_serviceable;
  51     SGPropertyNode *cdi_serviceable, *gs_serviceable, *tofrom_serviceable;
  52
  53     string last_nav_id;
  54     bool last_nav_vor;
  55     int nav_play_count;
  56     time_t nav_last_time;
  57
  58     int index;                  // used for property binding
  59     string nav_fx_name;
  60     string dme_fx_name;
  61
  62     bool need_update;
  63
  64     bool power_btn;
  65     bool audio_btn;
  66
  67     string nav_id;
  68     string nav_trans_ident;
  69     bool nav_valid;
  70     bool nav_inrange;
  71     bool nav_has_dme;
  72     bool nav_has_gs;
  73     bool nav_loc;
  74     double nav_freq;
  75     double nav_alt_freq;
  76     string fmt_freq;            // formated frequency
  77     string fmt_alt_freq;        // formated alternate frequency
  78     double nav_heading;         // true heading to nav station
  79     double nav_radial;          // current radial we are on (taking
  80                                 // into consideration the vor station
  81                                 // alignment which likely doesn't
  82                                 // match the magnetic alignment
  83                                 // exactly.)
  84     double nav_sel_radial;
  85     double nav_target_radial;
  86     double nav_target_radial_true;
  87     double nav_target_auto_hdg;
  88     double nav_loclon;
  89     double nav_loclat;
  90     double nav_x;
  91     double nav_y;
  92     double nav_z;
  93     double nav_loc_dist;
  94     double nav_gslon;
  95     double nav_gslat;
  96     double nav_elev;            // use gs elev if available
  97     double nav_gs_x;
  98     double nav_gs_y;
  99     double nav_gs_z;
 100     sgdVec3 gs_base_vec;
 101     double nav_gs_dist;
 102     double nav_gs_dist_signed;
 103     double nav_gs_rate_of_climb;
 104     SGTimeStamp prev_time;
 105     SGTimeStamp curr_time;
 106     double nav_range;
 107     double nav_effective_range;
 108     double nav_target_gs;
 109     double nav_twist;
 110     double nav_vol_btn;
 111     bool nav_ident_btn;
 112     double horiz_vel;
 113     double last_x;
 114
 115     string name;
 116     int num;
 117
 118     // internal periodic station search timer
 119     double _time_before_search_sec;
 120
 121     // model standard VOR/DME/TACAN service volumes as per AIM 1-1-8
 122     double adjustNavRange( double stationElev, double aircraftElev,
 123                            double nominalRange );
 124
 125     // model standard ILS service volumes as per AIM 1-1-9
 126     double adjustILSRange( double stationElev, double aircraftElev,
 127                            double offsetDegrees, double distance );
 128
 129 public:
 130
 131     FGNavRadio(SGPropertyNode *node);
 132     ~FGNavRadio();
 133
 134     void init ();
 135     void bind ();
 136     void unbind ();
 137     void update (double dt);
 138
 139     // Update nav/adf radios based on current postition
 140     void search ();
 141 /*
 142     inline void set_bind_index( int i ) {
 143         index = i;
 144         sprintf( nav_fx_name, "nav%d-vor-ident", index );
 145         sprintf( dme_fx_name, "dme%d-vor-ident", index );
 146     }
 147 */
 148
 149     // NavCom Setters
 150     inline void set_power_btn( bool val ) { power_btn = val; }
 151     inline void set_audio_btn( bool val ) { audio_btn = val; }
 152
 153     // NAV Setters
 154     inline void set_nav_freq( double freq ) {
 155         nav_freq = freq; need_update = true;
 156     }
 157     inline void set_fmt_freq( const char *freq ) { fmt_freq = freq; }
 158     inline void set_nav_alt_freq( double freq ) { nav_alt_freq = freq; }
 159     inline void set_fmt_alt_freq( const char *freq ) { fmt_alt_freq = freq; }
 160     inline void set_nav_sel_radial( double radial ) {
 161         nav_sel_radial = radial; need_update = true;
 162     }
 163     inline void set_nav_vol_btn( double val ) {
 164         if ( val < 0.0 ) val = 0.0;
 165         if ( val > 1.0 ) val = 1.0;
 166         nav_vol_btn = val;
 167     }
 168     inline void set_nav_ident_btn( bool val ) { nav_ident_btn = val; }
 169
 170     // NavCom Accessors
 171     inline bool has_power() const {
 172         return power_btn && (bus_power->getDoubleValue() > 1.0);
 173     }
 174     inline bool get_power_btn() const { return power_btn; }
 175     inline bool get_audio_btn() const { return audio_btn; }
 176
 177     // NAV Accessors
 178     inline double get_nav_freq () const { return nav_freq; }
 179     inline const char *get_fmt_freq () const { return fmt_freq.c_str(); }
 180     inline double get_nav_alt_freq () const { return nav_alt_freq; }
 181     inline const char *get_fmt_alt_freq () const {
 182         return fmt_alt_freq.c_str();
 183     }
 184     inline double get_nav_sel_radial() const { return nav_sel_radial; }
 185     inline double get_nav_target_radial() const { return nav_target_radial; }
 186     inline double get_nav_target_radial_true() const {
 187         return nav_target_radial_true;
 188     }
 189     inline double get_nav_target_auto_hdg() const {
 190         return nav_target_auto_hdg;
 191     }
 192
 193     // Calculated values.
 194     inline bool get_nav_inrange() const { return nav_inrange; }
 195     bool get_nav_to_flag () const;
 196     bool get_nav_from_flag () const;
 197     inline bool get_nav_has_dme() const { return nav_has_dme; }
 198     inline bool get_nav_dme_inrange () const {
 199         return nav_inrange && nav_has_dme;
 200     }
 201     inline bool get_nav_has_gs() const { return nav_has_gs; }
 202     inline bool get_nav_loc() const { return nav_loc; }
 203     inline double get_nav_loclon() const { return nav_loclon; }
 204     inline double get_nav_loclat() const { return nav_loclat; }
 205     inline double get_nav_loc_dist() const { return nav_loc_dist; }
 206     inline double get_nav_gslon() const { return nav_gslon; }
 207     inline double get_nav_gslat() const { return nav_gslat; }
 208     inline double get_nav_gs_dist() const { return nav_gs_dist; }
 209     inline double get_nav_gs_dist_signed() const { return nav_gs_dist_signed; }
 210     inline double get_nav_gs_rate_of_climb() const {
 211         return nav_gs_rate_of_climb;
 212     }
 213     inline double get_nav_elev() const { return nav_elev; }
 214     double get_nav_heading() const;
 215     double get_nav_radial() const;
 216     double get_nav_reciprocal_radial() const;
 217     inline double get_nav_target_gs() const { return nav_target_gs; }
 218     inline double get_nav_twist() const { return nav_twist; }
 219     double get_nav_cdi_deflection() const;
 220     double get_nav_cdi_xtrack_error() const;
 221     double get_nav_gs_deflection() const;
 222     inline double get_nav_vol_btn() const { return nav_vol_btn; }
 223     inline bool get_nav_ident_btn() const { return nav_ident_btn; }
 224     inline const char * get_nav_id() const { return nav_id.c_str(); }
 225     inline int get_nav_id_c1() const { return nav_id.c_str()[0]; }
 226     inline int get_nav_id_c2() const { return nav_id.c_str()[1]; }
 227     inline int get_nav_id_c3() const { return nav_id.c_str()[2]; }
 228     inline int get_nav_id_c4() const { return nav_id.c_str()[3]; }
 229 };
 230
 231
 232 #endif // _FG_NAVRADIO_HXX