fly/flightgear
1
0
Fork 0
Code Activity

- implemented DME ETE and speed

Browse source 
- modified DME distance to return nautical miles rather than meters
- modified to use /panel/dme/switch-position to select DME frequency
This commit is contained in:
curt 2001-07-30 16:26:46 +00:00
parent d7c3801bae
commit ad48935028
1 changed files with 165 additions and 51 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

216
src/Cockpit/radiostack.cxx
View file

@ -84,9 +84,12 @@ FGRadioStack::FGRadioStack() :
alt_node(fgGetNode("/position/altitude-ft", true)),
need_update(true),
nav1_radial(0.0),
nav1_dme_dist(0.0),
nav2_radial(0.0),
nav2_dme_dist(0.0)
dme_freq(0.0),
dme_dist(0.0),
dme_prev_dist(0.0),
dme_spd(0.0),
dme_ete(0.0)
{
SGPath path( globals->get_fg_root() );
SGPath term = path;
@ -99,6 +102,7 @@ FGRadioStack::FGRadioStack() :
term_tbl = new SGInterpTable( term.str() );
low_tbl = new SGInterpTable( low.str() );
high_tbl = new SGInterpTable( high.str() );
dme_last_time.stamp();
}
@ -157,10 +161,6 @@ FGRadioStack::bind ()
fgTie("/radios/nav[0]/to-flag", this, &FGRadioStack::get_nav1_to_flag);
fgTie("/radios/nav[0]/from-flag", this, &FGRadioStack::get_nav1_from_flag);
fgTie("/radios/nav[0]/in-range", this, &FGRadioStack::get_nav1_inrange);
fgTie("/radios/nav[0]/dme/distance-nm", this,
&FGRadioStack::get_nav1_dme_dist);
fgTie("/radios/nav[0]/dme/in-range", this,
&FGRadioStack::get_nav1_dme_inrange);
fgTie("/radios/nav[0]/heading-needle-deflection", this,
&FGRadioStack::get_nav1_heading_needle_deflection);
fgTie("/radios/nav[0]/gs-needle-deflection", this,
@ -192,15 +192,21 @@ FGRadioStack::bind ()
fgTie("/radios/nav[1]/to-flag", this, &FGRadioStack::get_nav2_to_flag);
fgTie("/radios/nav[1]/from-flag", this, &FGRadioStack::get_nav2_from_flag);
fgTie("/radios/nav[1]/in-range", this, &FGRadioStack::get_nav2_inrange);
fgTie("/radios/nav[1]/dme/distance-nm", this,
&FGRadioStack::get_nav2_dme_dist);
fgTie("/radios/nav[1]/dme/in-range", this,
&FGRadioStack::get_nav2_dme_inrange);
fgTie("/radios/nav[1]/heading-needle-deflection", this,
&FGRadioStack::get_nav2_heading_needle_deflection);
fgTie("/radios/nav[1]/gs-needle-deflection", this,
&FGRadioStack::get_nav2_gs_needle_deflection);
// User inputs
fgTie("/radios/dme/frequencies/selected-khz", this,
&FGRadioStack::get_dme_freq, &FGRadioStack::set_adf_freq);
// Radio outputs
fgTie("/radios/dme/in-range", this, &FGRadioStack::get_dme_inrange);
fgTie("/radios/dme/distance-nm", this, &FGRadioStack::get_dme_dist);
fgTie("/radios/dme/speed-kt", this, &FGRadioStack::get_dme_spd);
fgTie("/radios/dme/ete-min", this, &FGRadioStack::get_dme_ete);
// User inputs
fgTie("/radios/adf/frequencies/selected-khz", this,
&FGRadioStack::get_adf_freq, &FGRadioStack::set_adf_freq);
@ -240,8 +246,6 @@ FGRadioStack::unbind ()
fgUntie("/radios/nav[0]/to-flag");
fgUntie("/radios/nav[0]/from-flag");
fgUntie("/radios/nav[0]/in-range");
fgUntie("/radios/nav[0]/dme/distance-nm");
fgUntie("/radios/nav[0]/dme/in-range");
fgUntie("/radios/nav[0]/heading-needle-deflection");
fgUntie("/radios/nav[0]/gs-needle-deflection");
@ -254,11 +258,17 @@ FGRadioStack::unbind ()
fgUntie("/radios/nav[1]/to-flag");
fgUntie("/radios/nav[1]/from-flag");
fgUntie("/radios/nav[1]/in-range");
fgUntie("/radios/nav[1]/dme/distance-nm");
fgUntie("/radios/nav[1]/dme/in-range");
fgUntie("/radios/nav[1]/heading-needle-deflection");
fgUntie("/radios/nav[1]/gs-needle-deflection");
fgUntie("/radios/dme/frequencies/selected-khz");
// Radio outputs
fgUntie("/radios/dme/in-range");
fgUntie("/radios/dme/distance-nm");
fgUntie("/radios/dme/speed-kt");
fgUntie("/radios/dme/ete-min");
fgUntie("/radios/adf/frequencies/selected-khz");
fgUntie("/radios/adf/frequencies/standby-khz");
fgUntie("/radios/adf/rotation-deg");
@ -341,18 +351,14 @@ FGRadioStack::update()
Point3D station;
double az1, az2, s;
////////////////////////////////////////////////////////////////////////
// Nav1.
////////////////////////////////////////////////////////////////////////
if ( nav1_valid ) {
station = Point3D( nav1_x, nav1_y, nav1_z );
nav1_loc_dist = aircraft.distance3D( station );
if ( nav1_has_dme ) {
// staightline distance
station = Point3D( nav1_dme_x, nav1_dme_y, nav1_dme_z );
nav1_dme_dist = aircraft.distance3D( station );
} else {
nav1_dme_dist = 0.0;
}
if ( nav1_has_gs ) {
station = Point3D( nav1_gs_x, nav1_gs_y, nav1_gs_z );
nav1_gs_dist = aircraft.distance3D( station );
@ -397,7 +403,6 @@ FGRadioStack::update()
}
} else {
nav1_inrange = false;
nav1_dme_dist = 0.0;
// cout << "not picking up vor. :-(" << endl;
}
@ -437,18 +442,15 @@ FGRadioStack::update()
}
#endif
////////////////////////////////////////////////////////////////////////
// Nav2.
////////////////////////////////////////////////////////////////////////
if ( nav2_valid ) {
station = Point3D( nav2_x, nav2_y, nav2_z );
nav2_loc_dist = aircraft.distance3D( station );
if ( nav2_has_dme ) {
// staightline distance
station = Point3D( nav2_dme_x, nav2_dme_y, nav2_dme_z );
nav2_dme_dist = aircraft.distance3D( station );
} else {
nav2_dme_dist = 0.0;
}
if ( nav2_has_gs ) {
station = Point3D( nav2_gs_x, nav2_gs_y, nav2_gs_z );
nav2_gs_dist = aircraft.distance3D( station );
@ -492,7 +494,6 @@ FGRadioStack::update()
}
} else {
nav2_inrange = false;
nav2_dme_dist = 0.0;
// cout << "not picking up vor. :-(" << endl;
}
@ -532,7 +533,58 @@ FGRadioStack::update()
}
#endif
// adf
////////////////////////////////////////////////////////////////////////
// DME.
////////////////////////////////////////////////////////////////////////
if (dme_valid) {
station = Point3D( dme_x, dme_y, dme_z );
dme_dist = aircraft.distance3D( station ) * SG_METER_TO_NM;
dme_effective_range = kludgeRange(dme_elev, elev, dme_range);
if (dme_dist < dme_effective_range * SG_NM_TO_METER) {
dme_inrange = true;
} else if (dme_dist < 2 * dme_effective_range * SG_NM_TO_METER) {
dme_inrange = sg_random() <
(2 * dme_effective_range * SG_NM_TO_METER - dme_dist) /
(dme_effective_range * SG_NM_TO_METER);
} else {
dme_inrange = false;
}
if (dme_inrange) {
SGTimeStamp current_time;
station = Point3D( dme_x, dme_y, dme_z );
dme_dist = aircraft.distance3D( station ) * SG_METER_TO_NM;
current_time.stamp();
long dMs = (current_time - dme_last_time) / 1000;
// Update every second
if (dMs >= 1000) {
double dDist = dme_dist - dme_prev_dist;
dme_spd = fabs((dDist/dMs) * 3600000);
// FIXME: the panel should be able to
// handle this!!!
if (dme_spd > 999.0)
dme_spd = 999.0;
dme_ete = fabs((dme_dist/dme_spd) * 60.0);
// FIXME: the panel should be able to
// handle this!!!
if (dme_ete > 99.0)
dme_ete = 99.0;
dme_prev_dist = dme_dist;
dme_last_time.stamp();
}
}
} else {
dme_inrange = false;
dme_dist = 0.0;
dme_prev_dist = 0.0;
}
////////////////////////////////////////////////////////////////////////
// ADF
////////////////////////////////////////////////////////////////////////
if ( adf_valid ) {
// staightline distance
station = Point3D( adf_x, adf_y, adf_z );
@ -630,7 +682,25 @@ void FGRadioStack::search()
double lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
double elev = alt_node->getDoubleValue() * SG_FEET_TO_METER;
// nav1
// FIXME: the panel should handle this
// don't worry about overhead for now,
// since this is handled only periodically
int dme_switch_pos = fgGetInt("/panel/dme/switch-position");
if (dme_switch_pos == 0) {
dme_freq = 0;
dme_inrange = false;
} else if (dme_switch_pos == 1) {
if (dme_freq != nav1_freq) {
dme_freq = nav1_freq;
need_update = true;
}
} else if (dme_switch_pos == 3) {
if (dme_freq != nav2_freq) {
dme_freq = nav2_freq;
need_update = true;
}
}
FGILS ils;
FGNav nav;
@ -639,6 +709,12 @@ void FGRadioStack::search()
static string last_adf_ident = "";
static bool last_nav1_vor = false;
static bool last_nav2_vor = false;
////////////////////////////////////////////////////////////////////////
// Nav1.
////////////////////////////////////////////////////////////////////////
if ( current_ilslist->query( lon, lat, elev, nav1_freq, &ils ) ) {
nav1_ident = ils.get_locident();
nav1_valid = true;
@ -654,8 +730,6 @@ void FGRadioStack::search()
nav1_loclat = ils.get_loclat();
nav1_gslon = ils.get_gslon();
nav1_gslat = ils.get_gslat();
nav1_dmelon = ils.get_dmelon();
nav1_dmelat = ils.get_dmelat();
nav1_elev = ils.get_gselev();
nav1_magvar = 0;
nav1_range = FG_ILS_DEFAULT_RANGE;
@ -670,9 +744,6 @@ void FGRadioStack::search()
nav1_gs_x = ils.get_gs_x();
nav1_gs_y = ils.get_gs_y();
nav1_gs_z = ils.get_gs_z();
nav1_dme_x = ils.get_dme_x();
nav1_dme_y = ils.get_dme_y();
nav1_dme_z = ils.get_dme_z();
#ifdef ENABLE_AUDIO_SUPPORT
if ( globals->get_soundmgr()->exists( "nav1-vor-ident" ) ) {
@ -722,9 +793,9 @@ void FGRadioStack::search()
nav1_effective_range = adjustNavRange(nav1_elev, elev, nav1_range);
nav1_target_gs = 0.0;
nav1_radial = nav1_sel_radial;
nav1_x = nav1_dme_x = nav.get_x();
nav1_y = nav1_dme_y = nav.get_y();
nav1_z = nav1_dme_z = nav.get_z();
nav1_x = nav.get_x();
nav1_y = nav.get_y();
nav1_z = nav.get_z();
#ifdef ENABLE_AUDIO_SUPPORT
if ( globals->get_soundmgr()->exists( "nav1-vor-ident" ) ) {
@ -759,7 +830,6 @@ void FGRadioStack::search()
nav1_valid = false;
nav1_ident = "";
nav1_radial = 0;
nav1_dme_dist = 0;
nav1_trans_ident = "";
last_nav1_ident = "";
#ifdef ENABLE_AUDIO_SUPPORT
@ -769,6 +839,11 @@ void FGRadioStack::search()
// cout << "not picking up vor1. :-(" << endl;
}
////////////////////////////////////////////////////////////////////////
// Nav2.
////////////////////////////////////////////////////////////////////////
if ( current_ilslist->query( lon, lat, elev, nav2_freq, &ils ) ) {
nav2_ident = ils.get_locident();
nav2_valid = true;
@ -796,9 +871,6 @@ void FGRadioStack::search()
nav2_gs_x = ils.get_gs_x();
nav2_gs_y = ils.get_gs_y();
nav2_gs_z = ils.get_gs_z();
nav2_dme_x = ils.get_dme_x();
nav2_dme_y = ils.get_dme_y();
nav2_dme_z = ils.get_dme_z();
#ifdef ENABLE_AUDIO_SUPPORT
if ( globals->get_soundmgr()->exists( "nav2-vor-ident" ) ) {
@ -847,9 +919,9 @@ void FGRadioStack::search()
nav2_effective_range = adjustNavRange(nav2_elev, elev, nav2_range);
nav2_target_gs = 0.0;
nav2_radial = nav2_sel_radial;
nav2_x = nav2_dme_x = nav.get_x();
nav2_y = nav2_dme_y = nav.get_y();
nav2_z = nav2_dme_z = nav.get_z();
nav2_x = nav.get_x();
nav2_y = nav.get_y();
nav2_z = nav.get_z();
#ifdef ENABLE_AUDIO_SUPPORT
if ( globals->get_soundmgr()->exists( "nav2-vor-ident" ) ) {
@ -884,7 +956,6 @@ void FGRadioStack::search()
nav2_valid = false;
nav2_ident = "";
nav2_radial = 0;
nav2_dme_dist = 0;
nav2_trans_ident = "";
last_nav2_ident = "";
#ifdef ENABLE_AUDIO_SUPPORT
@ -894,6 +965,45 @@ void FGRadioStack::search()
// cout << "not picking up vor1. :-(" << endl;
}
////////////////////////////////////////////////////////////////////////
// DME
////////////////////////////////////////////////////////////////////////
if ( current_ilslist->query( lon, lat, elev, dme_freq, &ils ) ) {
if (ils.get_has_dme()) {
dme_valid = true;
dme_lon = ils.get_loclon();
dme_lat = ils.get_loclat();
dme_elev = ils.get_gselev();
dme_range = FG_ILS_DEFAULT_RANGE;
dme_effective_range = kludgeRange(dme_elev, elev, dme_range);
dme_x = ils.get_dme_x();
dme_y = ils.get_dme_y();
dme_z = ils.get_dme_z();
}
} else if ( current_navlist->query( lon, lat, elev, dme_freq, &nav ) ) {
if (nav.get_has_dme()) {
dme_valid = true;
dme_lon = nav.get_lon();
dme_lat = nav.get_lat();
dme_elev = nav.get_elev();
dme_range = nav.get_range();
dme_effective_range = kludgeRange(dme_elev, elev, dme_range);
dme_x = nav.get_x();
dme_y = nav.get_y();
dme_z = nav.get_z();
}
} else {
dme_valid = false;
dme_dist = 0;
}
////////////////////////////////////////////////////////////////////////
// Beacons.
////////////////////////////////////////////////////////////////////////
FGMkrBeacon::fgMkrBeacType beacon_type
= current_beacons->query( lon * SGD_RADIANS_TO_DEGREES,
lat * SGD_RADIANS_TO_DEGREES, elev );
@ -955,7 +1065,11 @@ void FGRadioStack::search()
}
last_beacon = beacon_type;
// adf
////////////////////////////////////////////////////////////////////////
// ADF.
////////////////////////////////////////////////////////////////////////
if ( current_navlist->query( lon, lat, elev, adf_freq, &nav ) ) {
char freq[128];
#if defined( _MSC_VER )