// navradio.hxx -- class to manage a nav radio instance // // Written by Curtis Olson, started April 2000. // // Copyright (C) 2000 - 2002 Curtis L. Olson - http://www.flightgear.org/~curt // // 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. // // $Id$ #ifndef _FG_NAVRADIO_HXX #define _FG_NAVRADIO_HXX #include
#include "Sound/morse.hxx" #include #include #include // forward decls class SGInterpTable; class SGSampleGroup; class FGNavRecord; typedef SGSharedPtr FGNavRecordPtr; class FGNavRadio : public SGSubsystem { FGMorse morse; SGInterpTable *term_tbl; SGInterpTable *low_tbl; SGInterpTable *high_tbl; SGPropertyNode_ptr lon_node; SGPropertyNode_ptr lat_node; SGPropertyNode_ptr alt_node; SGPropertyNode_ptr bus_power_node; // property inputs SGPropertyNode_ptr is_valid_node; // is station data valid (may be way out // of range.) SGPropertyNode_ptr power_btn_node; SGPropertyNode_ptr freq_node; // primary freq SGPropertyNode_ptr alt_freq_node; // standby freq SGPropertyNode_ptr sel_radial_node; // selected radial SGPropertyNode_ptr vol_btn_node; SGPropertyNode_ptr ident_btn_node; SGPropertyNode_ptr audio_btn_node; SGPropertyNode_ptr backcourse_node; SGPropertyNode_ptr nav_serviceable_node; SGPropertyNode_ptr cdi_serviceable_node; SGPropertyNode_ptr gs_serviceable_node; SGPropertyNode_ptr tofrom_serviceable_node; SGPropertyNode_ptr dme_serviceable_node; // property outputs SGPropertyNode_ptr fmt_freq_node; // formated frequency SGPropertyNode_ptr fmt_alt_freq_node; // formated alternate frequency SGPropertyNode_ptr heading_node; // true heading to nav station SGPropertyNode_ptr radial_node; // current radial we are on (taking // into consideration the vor station // alignment which likely doesn't // match the magnetic alignment // exactly.) SGPropertyNode_ptr recip_radial_node; // radial_node(val) + 180 (for // convenience) SGPropertyNode_ptr target_radial_true_node; // true heading of selected radial SGPropertyNode_ptr target_auto_hdg_node; // suggested autopilot heading // to intercept selected radial SGPropertyNode_ptr time_to_intercept; // estimated time to intecept selected // radial at current speed and heading SGPropertyNode_ptr to_flag_node; SGPropertyNode_ptr from_flag_node; SGPropertyNode_ptr inrange_node; SGPropertyNode_ptr signal_quality_norm_node; SGPropertyNode_ptr cdi_deflection_node; SGPropertyNode_ptr cdi_deflection_norm_node; SGPropertyNode_ptr cdi_xtrack_error_node; SGPropertyNode_ptr cdi_xtrack_hdg_err_node; SGPropertyNode_ptr has_gs_node; SGPropertyNode_ptr loc_node; SGPropertyNode_ptr loc_dist_node; SGPropertyNode_ptr gs_deflection_node; SGPropertyNode_ptr gs_deflection_deg_node; SGPropertyNode_ptr gs_deflection_norm_node; SGPropertyNode_ptr gs_rate_of_climb_node; SGPropertyNode_ptr gs_dist_node; SGPropertyNode_ptr gs_inrange_node; SGPropertyNode_ptr nav_id_node; SGPropertyNode_ptr id_c1_node; SGPropertyNode_ptr id_c2_node; SGPropertyNode_ptr id_c3_node; SGPropertyNode_ptr id_c4_node; // gps slaving support SGPropertyNode_ptr nav_slaved_to_gps_node; SGPropertyNode_ptr gps_cdi_deflection_node; SGPropertyNode_ptr gps_to_flag_node; SGPropertyNode_ptr gps_from_flag_node; SGPropertyNode_ptr gps_has_gs_node; // internal (private) values int play_count; time_t last_time; FGNavRecordPtr _navaid; FGNavRecordPtr _gs; string nav_fx_name; string dme_fx_name; double target_radial; SGTimeStamp prev_time; SGTimeStamp curr_time; double effective_range; double target_gs; double twist; double horiz_vel; double last_x; double last_loc_dist; double last_xtrack_error; double _localizerWidth; // cached localizer width in degrees string _name; int _num; // internal periodic station search timer double _time_before_search_sec; SGVec3d _gsCart, _gsAxis, _gsVertical; FGNavRecordPtr _dme; bool _dmeInRange; // CDI properties bool _toFlag, _fromFlag; double _cdiDeflection; double _cdiCrossTrackErrorM; double _gsNeedleDeflection; double _gsNeedleDeflectionNorm; // realism setting, are false courses and GS lobes enabled? bool _falseCoursesEnabled; SGSampleGroup *_sgr; bool updateWithPower(double aDt); // model standard VOR/DME/TACAN service volumes as per AIM 1-1-8 double adjustNavRange( double stationElev, double aircraftElev, double nominalRange ); // model standard ILS service volumes as per AIM 1-1-9 double adjustILSRange( double stationElev, double aircraftElev, double offsetDegrees, double distance ); void updateAudio(); void audioNavidChanged(); void updateReceiver(double dt); void updateDME(const SGVec3d& aircraft); void updateGlideSlope(double dt, const SGVec3d& aircraft, double signal_quality_norm); void updateGPSSlaved(); void updateCDI(double dt); void clearOutputs(); /** * Compute the localizer width in degrees - see implementation for * more information on the relevant standards and formulae. */ double localizerWidth(FGNavRecord* aLOC); FGNavRecord* findPrimaryNavaid(const SGGeod& aPos, double aFreqMHz); public: FGNavRadio(SGPropertyNode *node); ~FGNavRadio(); void init (); void bind (); void unbind (); void update (double dt); // Update nav/adf radios based on current postition void search (); }; #endif // _FG_NAVRADIO_HXX