//
// 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., 675 Mass Ave, Cambridge, MA 02139, USA.
+// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
//
// $Id$
#include <Main/fg_props.hxx>
+#include "Sound/morse.hxx"
#include <simgear/compiler.h>
#include <simgear/structure/subsystem_mgr.hxx>
-#include <simgear/math/interpolater.hxx>
#include <simgear/timing/timestamp.hxx>
-#include <Navaids/navlist.hxx>
-#include <Sound/morse.hxx>
+// forward decls
+class SGInterpTable;
+
+class SGSampleGroup;
+class FGNavRecord;
+typedef SGSharedPtr<FGNavRecord> FGNavRecordPtr;
class FGNavRadio : public SGSubsystem
{
SGInterpTable *low_tbl;
SGInterpTable *high_tbl;
- SGPropertyNode *lon_node;
- SGPropertyNode *lat_node;
- SGPropertyNode *alt_node;
- SGPropertyNode *bus_power_node;
+ SGPropertyNode_ptr _radio_node;
+ SGPropertyNode_ptr lon_node;
+ SGPropertyNode_ptr lat_node;
+ SGPropertyNode_ptr alt_node;
+ SGPropertyNode_ptr bus_power_node;
// property inputs
- SGPropertyNode *power_btn_node;
- SGPropertyNode *freq_node; // primary freq
- SGPropertyNode *alt_freq_node; // standby freq
- SGPropertyNode *sel_radial_node; // selected radial
- SGPropertyNode *vol_btn_node;
- SGPropertyNode *ident_btn_node;
- SGPropertyNode *audio_btn_node;
- SGPropertyNode *nav_serviceable_node;
- SGPropertyNode *cdi_serviceable_node;
- SGPropertyNode *gs_serviceable_node;
- SGPropertyNode *tofrom_serviceable_node;
-
+ 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 *fmt_freq_node; // formated frequency
- SGPropertyNode *fmt_alt_freq_node; // formated alternate frequency
- SGPropertyNode *heading_node; // true heading to nav station
- SGPropertyNode *radial_node; // current radial we are on (taking
+ 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 *recip_radial_node; // radial_node(val) + 180 (for
+ SGPropertyNode_ptr recip_radial_node; // radial_node(val) + 180 (for
// convenience)
- SGPropertyNode *target_radial_true_node;
+ SGPropertyNode_ptr target_radial_true_node;
// true heading of selected radial
- SGPropertyNode *target_auto_hdg_node;
- SGPropertyNode *to_flag_node;
- SGPropertyNode *from_flag_node;
- SGPropertyNode *inrange_node;
- SGPropertyNode *cdi_deflection_node;
- SGPropertyNode *cdi_xtrack_error_node;
- SGPropertyNode *has_gs_node;
- SGPropertyNode *loc_node;
- SGPropertyNode *loc_dist_node;
- SGPropertyNode *gs_deflection_node;
- SGPropertyNode *gs_rate_of_climb_node;
- SGPropertyNode *gs_dist_node;
- SGPropertyNode *nav_id_node;
- SGPropertyNode *id_c1_node;
- SGPropertyNode *id_c2_node;
- SGPropertyNode *id_c3_node;
- SGPropertyNode *id_c4_node;
+ 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_rate_of_climb_fpm_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 *nav_slaved_to_gps_node;
- SGPropertyNode *gps_cdi_deflection_node;
- SGPropertyNode *gps_to_flag_node;
- SGPropertyNode *gps_from_flag_node;
+ 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;
+ SGPropertyNode_ptr gps_course_node;
+ SGPropertyNode_ptr gps_xtrack_error_nm_node;
+ SGPropertyNode_ptr _magvarNode;
+
+ // realism setting, are false courses and GS lobes enabled?
+ SGPropertyNode_ptr falseCoursesEnabledNode;
// internal (private) values
- string last_nav_id;
- bool last_nav_vor;
+ bool _operable; ///< is the unit serviceable, on, powered, etc
int play_count;
time_t last_time;
-
- int index; // used for property binding
+ FGNavRecordPtr _navaid;
+ FGNavRecordPtr _gs;
+
string nav_fx_name;
string dme_fx_name;
- string trans_ident;
- bool is_valid;
- bool has_dme;
- double radial;
double target_radial;
- double loc_lon;
- double loc_lat;
- double nav_x;
- double nav_y;
- double nav_z;
- double gs_lon;
- double gs_lat;
- double nav_elev; // use gs elev if available
- double gs_x;
- double gs_y;
- double gs_z;
- sgdVec3 gs_base_vec;
- double gs_dist_signed;
SGTimeStamp prev_time;
SGTimeStamp curr_time;
- double range;
double effective_range;
double target_gs;
double twist;
double horiz_vel;
double last_x;
-
- string name;
- int num;
+ double last_loc_dist;
+ double last_xtrack_error;
+ double xrate_ms;
+ 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;
+
+ SGSharedPtr<SGSampleGroup> _sgr;
+ std::vector<SGPropertyNode_ptr> _tiedNodes;
+
+ 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 );
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);
+
+ /// accessor for tied, read-only 'operable' property
+ bool isOperable() const
+ { return _operable; }
+
+ /**
+ * Tied-properties helper, record nodes which are tied for easy un-tie-ing
+ */
+ template <typename T>
+ void tie(const char* aRelPath, const SGRawValue<T>& aRawValue)
+ {
+ SGPropertyNode_ptr nd = _radio_node->getNode(aRelPath, true);
+ _tiedNodes.push_back(nd);
+ nd->tie(aRawValue);
+ }
public:
FGNavRadio(SGPropertyNode *node);
// Update nav/adf radios based on current postition
void search ();
-
- // NavCom Accessors
- inline bool has_power() const {
- return power_btn_node->getBoolValue()
- && (bus_power_node->getDoubleValue() > 1.0);
- }
};