1 // navradio.hxx -- class to manage a nav radio instance
3 // Written by Curtis Olson, started April 2000.
5 // Copyright (C) 2000 - 2002 Curtis L. Olson - http://www.flightgear.org/~curt
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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
24 #ifndef _FG_NAVRADIO_HXX
25 #define _FG_NAVRADIO_HXX
28 #include <Main/fg_props.hxx>
29 #include "Sound/morse.hxx"
31 #include <simgear/compiler.h>
32 #include <simgear/structure/subsystem_mgr.hxx>
33 #include <simgear/timing/timestamp.hxx>
39 typedef SGSharedPtr<FGNavRecord> FGNavRecordPtr;
41 class FGNavRadio : public SGSubsystem
45 SGInterpTable *term_tbl;
46 SGInterpTable *low_tbl;
47 SGInterpTable *high_tbl;
49 SGPropertyNode_ptr lon_node;
50 SGPropertyNode_ptr lat_node;
51 SGPropertyNode_ptr alt_node;
52 SGPropertyNode_ptr bus_power_node;
55 SGPropertyNode_ptr is_valid_node; // is station data valid (may be way out
57 SGPropertyNode_ptr power_btn_node;
58 SGPropertyNode_ptr freq_node; // primary freq
59 SGPropertyNode_ptr alt_freq_node; // standby freq
60 SGPropertyNode_ptr sel_radial_node; // selected radial
61 SGPropertyNode_ptr vol_btn_node;
62 SGPropertyNode_ptr ident_btn_node;
63 SGPropertyNode_ptr audio_btn_node;
64 SGPropertyNode_ptr backcourse_node;
65 SGPropertyNode_ptr nav_serviceable_node;
66 SGPropertyNode_ptr cdi_serviceable_node;
67 SGPropertyNode_ptr gs_serviceable_node;
68 SGPropertyNode_ptr tofrom_serviceable_node;
71 SGPropertyNode_ptr fmt_freq_node; // formated frequency
72 SGPropertyNode_ptr fmt_alt_freq_node; // formated alternate frequency
73 SGPropertyNode_ptr heading_node; // true heading to nav station
74 SGPropertyNode_ptr radial_node; // current radial we are on (taking
75 // into consideration the vor station
76 // alignment which likely doesn't
77 // match the magnetic alignment
79 SGPropertyNode_ptr recip_radial_node; // radial_node(val) + 180 (for
81 SGPropertyNode_ptr target_radial_true_node;
82 // true heading of selected radial
83 SGPropertyNode_ptr target_auto_hdg_node;
84 // suggested autopilot heading
85 // to intercept selected radial
86 SGPropertyNode_ptr time_to_intercept; // estimated time to intecept selected
87 // radial at current speed and heading
88 SGPropertyNode_ptr to_flag_node;
89 SGPropertyNode_ptr from_flag_node;
90 SGPropertyNode_ptr inrange_node;
91 SGPropertyNode_ptr signal_quality_norm_node;
92 SGPropertyNode_ptr cdi_deflection_node;
93 SGPropertyNode_ptr cdi_deflection_norm_node;
94 SGPropertyNode_ptr cdi_xtrack_error_node;
95 SGPropertyNode_ptr cdi_xtrack_hdg_err_node;
96 SGPropertyNode_ptr has_gs_node;
97 SGPropertyNode_ptr loc_node;
98 SGPropertyNode_ptr loc_dist_node;
99 SGPropertyNode_ptr gs_deflection_node;
100 SGPropertyNode_ptr gs_deflection_deg_node;
101 SGPropertyNode_ptr gs_deflection_norm_node;
102 SGPropertyNode_ptr gs_rate_of_climb_node;
103 SGPropertyNode_ptr gs_dist_node;
104 SGPropertyNode_ptr gs_inrange_node;
105 SGPropertyNode_ptr nav_id_node;
106 SGPropertyNode_ptr id_c1_node;
107 SGPropertyNode_ptr id_c2_node;
108 SGPropertyNode_ptr id_c3_node;
109 SGPropertyNode_ptr id_c4_node;
111 // gps slaving support
112 SGPropertyNode_ptr nav_slaved_to_gps_node;
113 SGPropertyNode_ptr gps_cdi_deflection_node;
114 SGPropertyNode_ptr gps_to_flag_node;
115 SGPropertyNode_ptr gps_from_flag_node;
116 SGPropertyNode_ptr gps_has_gs_node;
118 // internal (private) values
122 FGNavRecordPtr _navaid;
129 double target_radial;
130 SGTimeStamp prev_time;
131 SGTimeStamp curr_time;
132 double effective_range;
137 double last_loc_dist;
138 double last_xtrack_error;
139 double _localizerWidth; // cached localizer width in degrees
144 // internal periodic station search timer
145 double _time_before_search_sec;
147 SGVec3d _gsCart, _gsAxis, _gsVertical;
150 bool _toFlag, _fromFlag;
151 double _cdiDeflection;
152 double _cdiCrossTrackErrorM;
153 double _gsNeedleDeflection;
154 double _gsNeedleDeflectionNorm;
156 bool updateWithPower(double aDt);
158 // model standard VOR/DME/TACAN service volumes as per AIM 1-1-8
159 double adjustNavRange( double stationElev, double aircraftElev,
160 double nominalRange );
162 // model standard ILS service volumes as per AIM 1-1-9
163 double adjustILSRange( double stationElev, double aircraftElev,
164 double offsetDegrees, double distance );
167 void audioNavidChanged();
169 void updateReceiver(double dt);
170 void updateGlideSlope(double dt, const SGVec3d& aircraft, double signal_quality_norm);
171 void updateGPSSlaved();
172 void updateCDI(double dt);
177 * Compute the localizer width in degrees - see implementation for
178 * more information on the relevant standards and formulae.
180 double localizerWidth(FGNavRecord* aLOC);
181 FGNavRecord* findPrimaryNavaid(const SGGeod& aPos, double aFreqMHz);
184 FGNavRadio(SGPropertyNode *node);
190 void update (double dt);
192 // Update nav/adf radios based on current postition
197 #endif // _FG_NAVRADIO_HXX