Shuffling/reorganizing code.
This commit is contained in:
parent
2a19fc2f53
commit
eaf4954441
6 changed files with 395 additions and 191 deletions
|
@ -2,6 +2,7 @@ noinst_LIBRARIES = libCockpit.a
|
|||
|
||||
libCockpit_a_SOURCES = \
|
||||
cockpit.cxx cockpit.hxx \
|
||||
dme.cxx dme.hxx \
|
||||
hud.cxx hud.hxx hud_opts.hxx \
|
||||
hud_card.cxx hud_dnst.cxx hud_gaug.cxx hud_inst.cxx \
|
||||
hud_labl.cxx hud_ladr.cxx \
|
||||
|
|
253
src/Cockpit/dme.cxx
Normal file
253
src/Cockpit/dme.cxx
Normal file
|
@ -0,0 +1,253 @@
|
|||
// dme.cxx -- class to manage an instance of the DME
|
||||
//
|
||||
// Written by Curtis Olson, started April 2000.
|
||||
//
|
||||
// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org
|
||||
//
|
||||
// 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
//
|
||||
// $Id$
|
||||
|
||||
|
||||
#ifdef HAVE_CONFIG_H
|
||||
# include <config.h>
|
||||
#endif
|
||||
|
||||
#include <stdio.h> // snprintf
|
||||
|
||||
#include <simgear/compiler.h>
|
||||
#include <simgear/math/sg_random.h>
|
||||
|
||||
#include <Aircraft/aircraft.hxx>
|
||||
#include <Navaids/ilslist.hxx>
|
||||
#include <Navaids/mkrbeacons.hxx>
|
||||
#include <Navaids/navlist.hxx>
|
||||
#include <Time/FGEventMgr.hxx>
|
||||
|
||||
#include "dme.hxx"
|
||||
|
||||
#include <string>
|
||||
SG_USING_STD(string);
|
||||
|
||||
|
||||
/**
|
||||
* Boy, this is ugly! Make the VOR range vary by altitude difference.
|
||||
*/
|
||||
static double kludgeRange ( double stationElev, double aircraftElev,
|
||||
double nominalRange)
|
||||
{
|
||||
// Assume that the nominal range (usually
|
||||
// 50nm) applies at a 5,000 ft difference.
|
||||
// Just a wild guess!
|
||||
double factor = ((aircraftElev*SG_METER_TO_FEET) - stationElev) / 5000.0;
|
||||
double range = fabs(nominalRange * factor);
|
||||
|
||||
// Clamp the range to keep it sane; for
|
||||
// now, never less than 25% or more than
|
||||
// 500% of nominal range.
|
||||
if (range < nominalRange/4.0) {
|
||||
range = nominalRange/4.0;
|
||||
} else if (range > nominalRange*5.0) {
|
||||
range = nominalRange*5.0;
|
||||
}
|
||||
|
||||
return range;
|
||||
}
|
||||
|
||||
|
||||
// Constructor
|
||||
FGDME::FGDME() :
|
||||
lon_node(fgGetNode("/position/longitude-deg", true)),
|
||||
lat_node(fgGetNode("/position/latitude-deg", true)),
|
||||
alt_node(fgGetNode("/position/altitude-ft", true)),
|
||||
bus_power(fgGetNode("/systems/electrical/outputs/dme", true)),
|
||||
navcom1_bus_power(fgGetNode("/systems/electrical/outputs/navcom[0]", true)),
|
||||
navcom2_bus_power(fgGetNode("/systems/electrical/outputs/navcom[1]", true)),
|
||||
navcom1_power_btn(fgGetNode("/radios/comm[0]/inputs/power-btn", true)),
|
||||
navcom2_power_btn(fgGetNode("/radios/comm[1]/inputs/power-btn", true)),
|
||||
navcom1_freq(fgGetNode("/radios/nav[0]/frequencies/selected-mhz", true)),
|
||||
navcom2_freq(fgGetNode("/radios/nav[1]/frequencies/selected-mhz", true)),
|
||||
need_update(true),
|
||||
freq(0.0),
|
||||
dist(0.0),
|
||||
prev_dist(0.0),
|
||||
spd(0.0),
|
||||
ete(0.0)
|
||||
{
|
||||
last_time.stamp();
|
||||
}
|
||||
|
||||
|
||||
// Destructor
|
||||
FGDME::~FGDME()
|
||||
{
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
FGDME::init ()
|
||||
{
|
||||
search();
|
||||
update(0); // FIXME: use dt
|
||||
}
|
||||
|
||||
void
|
||||
FGDME::bind ()
|
||||
{
|
||||
|
||||
// User inputs
|
||||
fgTie("/radios/dme/frequencies/selected-khz", this,
|
||||
&FGDME::get_freq, &FGDME::set_freq);
|
||||
|
||||
// Radio outputs
|
||||
fgTie("/radios/dme/in-range", this, &FGDME::get_inrange);
|
||||
|
||||
fgTie("/radios/dme/distance-nm", this, &FGDME::get_dist);
|
||||
|
||||
fgTie("/radios/dme/speed-kt", this, &FGDME::get_spd);
|
||||
|
||||
fgTie("/radios/dme/ete-min", this, &FGDME::get_ete);
|
||||
}
|
||||
|
||||
void
|
||||
FGDME::unbind ()
|
||||
{
|
||||
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");
|
||||
}
|
||||
|
||||
|
||||
// Update the various nav values based on position and valid tuned in navs
|
||||
void
|
||||
FGDME::update(double dt)
|
||||
{
|
||||
double lon = lon_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
|
||||
double lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
|
||||
double elev = alt_node->getDoubleValue() * SG_FEET_TO_METER;
|
||||
|
||||
need_update = false;
|
||||
|
||||
Point3D aircraft = sgGeodToCart( Point3D( lon, lat, elev ) );
|
||||
Point3D station;
|
||||
|
||||
if ( valid && has_power() ) {
|
||||
station = Point3D( x, y, z );
|
||||
dist = aircraft.distance3D( station ) * SG_METER_TO_NM;
|
||||
effective_range = kludgeRange(elev, elev, range);
|
||||
if (dist < effective_range * SG_NM_TO_METER) {
|
||||
inrange = true;
|
||||
} else if (dist < 2 * effective_range * SG_NM_TO_METER) {
|
||||
inrange = sg_random() <
|
||||
(2 * effective_range * SG_NM_TO_METER - dist) /
|
||||
(effective_range * SG_NM_TO_METER);
|
||||
} else {
|
||||
inrange = false;
|
||||
}
|
||||
if ( inrange ) {
|
||||
SGTimeStamp current_time;
|
||||
station = Point3D( x, y, z );
|
||||
dist = aircraft.distance3D( station ) * SG_METER_TO_NM;
|
||||
current_time.stamp();
|
||||
long dMs = (current_time - last_time) / 1000;
|
||||
// Update every second
|
||||
if (dMs >= 1000) {
|
||||
double dDist = dist - prev_dist;
|
||||
spd = fabs((dDist/dMs) * 3600000);
|
||||
// FIXME: the panel should be able to
|
||||
// handle this!!!
|
||||
if (spd > 999.0)
|
||||
spd = 999.0;
|
||||
ete = fabs((dist/spd) * 60.0);
|
||||
// FIXME: the panel should be able to
|
||||
// handle this!!!
|
||||
if (ete > 99.0)
|
||||
ete = 99.0;
|
||||
prev_dist = dist;
|
||||
last_time.stamp();
|
||||
}
|
||||
}
|
||||
} else {
|
||||
inrange = false;
|
||||
dist = 0.0;
|
||||
prev_dist = 0.0;
|
||||
spd = 0.0;
|
||||
ete = 0.0;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
// Update current nav/adf radio stations based on current postition
|
||||
void FGDME::search()
|
||||
{
|
||||
double lon = lon_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
|
||||
double lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
|
||||
double elev = alt_node->getDoubleValue() * SG_FEET_TO_METER;
|
||||
|
||||
// FIXME: the panel should handle this
|
||||
// don't worry about overhead for now,
|
||||
// since this is handled only periodically
|
||||
switch_pos = fgGetInt("/radios/dme/switch-position", 2);
|
||||
if ( switch_pos == 1 && has_power() && navcom1_on() ) {
|
||||
if ( freq != navcom1_freq->getDoubleValue() ) {
|
||||
freq = navcom1_freq->getDoubleValue();
|
||||
need_update = true;
|
||||
}
|
||||
} else if ( switch_pos == 3 && has_power() && navcom2_on() ) {
|
||||
if ( freq != navcom2_freq->getDoubleValue() ) {
|
||||
freq = navcom2_freq->getDoubleValue();
|
||||
need_update = true;
|
||||
}
|
||||
} else {
|
||||
freq = 0;
|
||||
inrange = false;
|
||||
}
|
||||
|
||||
FGILS ils;
|
||||
FGNav nav;
|
||||
|
||||
if ( current_ilslist->query( lon, lat, elev, freq, &ils ) ) {
|
||||
if (ils.get_has_dme()) {
|
||||
valid = true;
|
||||
lon = ils.get_loclon();
|
||||
lat = ils.get_loclat();
|
||||
elev = ils.get_gselev();
|
||||
range = FG_ILS_DEFAULT_RANGE;
|
||||
effective_range = kludgeRange(elev, elev, range);
|
||||
x = ils.get_dme_x();
|
||||
y = ils.get_dme_y();
|
||||
z = ils.get_dme_z();
|
||||
}
|
||||
} else if ( current_navlist->query( lon, lat, elev, freq, &nav ) ) {
|
||||
if (nav.get_has_dme()) {
|
||||
valid = true;
|
||||
lon = nav.get_lon();
|
||||
lat = nav.get_lat();
|
||||
elev = nav.get_elev();
|
||||
range = nav.get_range();
|
||||
effective_range = kludgeRange(elev, elev, range);
|
||||
x = nav.get_x();
|
||||
y = nav.get_y();
|
||||
z = nav.get_z();
|
||||
}
|
||||
} else {
|
||||
valid = false;
|
||||
dist = 0;
|
||||
}
|
||||
}
|
117
src/Cockpit/dme.hxx
Normal file
117
src/Cockpit/dme.hxx
Normal file
|
@ -0,0 +1,117 @@
|
|||
// dme.hxx -- class to manage an instance of the DME
|
||||
//
|
||||
// Written by Curtis Olson, started April 2000.
|
||||
//
|
||||
// Copyright (C) 2000 Curtis L. Olson - curt@flightgear.org
|
||||
//
|
||||
// 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., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||
//
|
||||
// $Id$
|
||||
|
||||
|
||||
#ifndef _FG_DME_HXX
|
||||
#define _FG_DME_HXX
|
||||
|
||||
|
||||
#include <Main/fgfs.hxx>
|
||||
#include <Main/fg_props.hxx>
|
||||
|
||||
#include <simgear/compiler.h>
|
||||
|
||||
// #include <simgear/math/interpolater.hxx>
|
||||
#include <simgear/timing/timestamp.hxx>
|
||||
|
||||
#include <Navaids/ilslist.hxx>
|
||||
#include <Navaids/navlist.hxx>
|
||||
// #include <Sound/beacon.hxx>
|
||||
#include <Sound/morse.hxx>
|
||||
|
||||
// #include "kr_87.hxx" // ADF
|
||||
// #include "kt_70.hxx" // Transponder
|
||||
// #include "navcom.hxx"
|
||||
|
||||
class FGDME : public FGSubsystem
|
||||
{
|
||||
SGPropertyNode *lon_node;
|
||||
SGPropertyNode *lat_node;
|
||||
SGPropertyNode *alt_node;
|
||||
SGPropertyNode *bus_power;
|
||||
SGPropertyNode *navcom1_bus_power, *navcom2_bus_power;
|
||||
SGPropertyNode *navcom1_power_btn, *navcom2_power_btn;
|
||||
SGPropertyNode *navcom1_freq, *navcom2_freq;
|
||||
|
||||
bool need_update;
|
||||
|
||||
bool valid;
|
||||
int switch_pos;
|
||||
bool inrange;
|
||||
double freq;
|
||||
double lon;
|
||||
double lat;
|
||||
double elev;
|
||||
double range;
|
||||
double effective_range;
|
||||
double x;
|
||||
double y;
|
||||
double z;
|
||||
double dist;
|
||||
double prev_dist;
|
||||
double spd;
|
||||
double ete;
|
||||
SGTimeStamp last_time;
|
||||
|
||||
public:
|
||||
|
||||
FGDME();
|
||||
~FGDME();
|
||||
|
||||
void init ();
|
||||
void bind ();
|
||||
void unbind ();
|
||||
void update (double dt);
|
||||
|
||||
// Update dme based on current postition
|
||||
void search ();
|
||||
|
||||
// DME Setters
|
||||
inline void set_freq (double freq) {
|
||||
freq = freq; need_update = true;
|
||||
}
|
||||
|
||||
|
||||
// DME Accessors
|
||||
inline bool has_power() const {
|
||||
return (switch_pos == 1 || switch_pos == 3)
|
||||
&& (bus_power->getDoubleValue() > 1.0);
|
||||
}
|
||||
inline bool navcom1_on() const {
|
||||
return (navcom1_bus_power->getDoubleValue() > 1.0)
|
||||
&& navcom1_power_btn->getBoolValue();
|
||||
}
|
||||
inline bool navcom2_on() const {
|
||||
return (navcom2_bus_power->getDoubleValue() > 1.0)
|
||||
&& navcom2_power_btn->getBoolValue();
|
||||
}
|
||||
inline double get_freq () const { return freq; }
|
||||
|
||||
// Calculated values.
|
||||
inline bool get_inrange () const { return inrange; }
|
||||
inline double get_dist () const { return dist; }
|
||||
inline double get_spd () const { return spd; }
|
||||
inline double get_ete () const { return ete; }
|
||||
};
|
||||
|
||||
|
||||
#endif // _FG_DME_HXX
|
|
@ -100,13 +100,6 @@ FGNavCom::bind ()
|
|||
{
|
||||
char propname[256];
|
||||
|
||||
// we know index is valid now so lets bind to the bus property
|
||||
// here.
|
||||
sprintf( propname, "/systems/electrical/outputs/navcomm[%d]", index );
|
||||
// default to true in case no electrical system defined.
|
||||
fgSetDouble( propname, 60.0 );
|
||||
bus_power = fgGetNode( propname, true );
|
||||
|
||||
// User inputs
|
||||
sprintf( propname, "/radios/comm[%d]/inputs/power-btn", index );
|
||||
fgTie( propname, this,
|
||||
|
@ -170,6 +163,15 @@ FGNavCom::bind ()
|
|||
|
||||
sprintf( propname, "/radios/nav[%d]/gs-needle-deflection", index );
|
||||
fgTie( propname, this, &FGNavCom::get_nav_gs_needle_deflection );
|
||||
|
||||
// end of binding
|
||||
|
||||
// We know index is valid now so lets bind to the bus property
|
||||
// here.
|
||||
sprintf( propname, "/systems/electrical/outputs/navcom[%d]", index );
|
||||
// default to true in case no electrical system defined.
|
||||
fgSetDouble( propname, 60.0 );
|
||||
bus_power = fgGetNode( propname, true );
|
||||
}
|
||||
|
||||
|
||||
|
|
|
@ -75,13 +75,7 @@ FGRadioStack::FGRadioStack() :
|
|||
lon_node(fgGetNode("/position/longitude-deg", true)),
|
||||
lat_node(fgGetNode("/position/latitude-deg", true)),
|
||||
alt_node(fgGetNode("/position/altitude-ft", true)),
|
||||
dme_bus_power(fgGetNode("/systems/electrical/outputs/dme", true)),
|
||||
need_update(true),
|
||||
dme_freq(0.0),
|
||||
dme_dist(0.0),
|
||||
dme_prev_dist(0.0),
|
||||
dme_spd(0.0),
|
||||
dme_ete(0.0),
|
||||
outer_blink(false),
|
||||
middle_blink(false),
|
||||
inner_blink(false)
|
||||
|
@ -97,7 +91,6 @@ FGRadioStack::FGRadioStack() :
|
|||
term_tbl = new SGInterpTable( term.str() );
|
||||
low_tbl = new SGInterpTable( low.str() );
|
||||
high_tbl = new SGInterpTable( high.str() );
|
||||
dme_last_time.stamp();
|
||||
}
|
||||
|
||||
|
||||
|
@ -150,23 +143,11 @@ FGRadioStack::init ()
|
|||
1000 );
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
FGRadioStack::bind ()
|
||||
{
|
||||
|
||||
// User inputs
|
||||
fgTie("/radios/dme/frequencies/selected-khz", this,
|
||||
&FGRadioStack::get_dme_freq, &FGRadioStack::set_dme_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);
|
||||
|
||||
fgTie("/radios/marker-beacon/inner", this,
|
||||
&FGRadioStack::get_inner_blink);
|
||||
|
||||
|
@ -176,32 +157,27 @@ FGRadioStack::bind ()
|
|||
fgTie("/radios/marker-beacon/outer", this,
|
||||
&FGRadioStack::get_outer_blink);
|
||||
|
||||
adf.bind();
|
||||
dme.bind();
|
||||
navcom1.set_bind_index( 0 );
|
||||
navcom1.bind();
|
||||
navcom2.set_bind_index( 1 );
|
||||
navcom2.bind();
|
||||
adf.bind();
|
||||
xponder.bind();
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
FGRadioStack::unbind ()
|
||||
{
|
||||
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/marker-beacon/inner");
|
||||
fgUntie("/radios/marker-beacon/middle");
|
||||
fgUntie("/radios/marker-beacon/outer");
|
||||
|
||||
adf.unbind();
|
||||
dme.unbind();
|
||||
navcom1.unbind();
|
||||
navcom2.unbind();
|
||||
adf.unbind();
|
||||
xponder.unbind();
|
||||
}
|
||||
|
||||
|
@ -210,65 +186,13 @@ FGRadioStack::unbind ()
|
|||
void
|
||||
FGRadioStack::update(double dt)
|
||||
{
|
||||
double lon = lon_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
|
||||
double lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
|
||||
double elev = alt_node->getDoubleValue() * SG_FEET_TO_METER;
|
||||
|
||||
need_update = false;
|
||||
|
||||
Point3D aircraft = sgGeodToCart( Point3D( lon, lat, elev ) );
|
||||
Point3D station;
|
||||
|
||||
adf.update( dt );
|
||||
navcom1.update( dt );
|
||||
navcom2.update( dt );
|
||||
|
||||
////////////////////////////////////////////////////////////////////////
|
||||
// DME.
|
||||
////////////////////////////////////////////////////////////////////////
|
||||
|
||||
if ( dme_valid && dme_has_power() ) {
|
||||
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;
|
||||
dme_spd = 0.0;
|
||||
dme_ete = 0.0;
|
||||
}
|
||||
dme.update( dt ); // dme is updated after the navcom's
|
||||
xponder.update( dt );
|
||||
|
||||
// marker beacon blinking
|
||||
bool light_on = ( outer_blink || middle_blink || inner_blink );
|
||||
|
@ -302,9 +226,6 @@ FGRadioStack::update(double dt)
|
|||
}
|
||||
|
||||
// cout << outer_blink << " " << middle_blink << " " << inner_blink << endl;
|
||||
|
||||
adf.update( dt );
|
||||
xponder.update( dt );
|
||||
}
|
||||
|
||||
|
||||
|
@ -317,64 +238,11 @@ void FGRadioStack::search()
|
|||
double lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS;
|
||||
double elev = alt_node->getDoubleValue() * SG_FEET_TO_METER;
|
||||
|
||||
// FIXME: the panel should handle this
|
||||
// don't worry about overhead for now,
|
||||
// since this is handled only periodically
|
||||
dme_switch_pos = fgGetInt("/radios/dme/switch-position", 2);
|
||||
if ( dme_switch_pos == 1 && dme_has_power() && navcom1.has_power() ) {
|
||||
if ( dme_freq != navcom1.get_nav_freq() ) {
|
||||
dme_freq = navcom1.get_nav_freq();
|
||||
need_update = true;
|
||||
}
|
||||
} else if ( dme_switch_pos == 3 && dme_has_power() && navcom2.has_power() ){
|
||||
if ( dme_freq != navcom2.get_nav_freq() ) {
|
||||
dme_freq = navcom2.get_nav_freq();
|
||||
need_update = true;
|
||||
}
|
||||
} else {
|
||||
dme_freq = 0;
|
||||
dme_inrange = false;
|
||||
}
|
||||
|
||||
FGILS ils;
|
||||
FGNav nav;
|
||||
|
||||
adf.search();
|
||||
navcom1.search();
|
||||
navcom2.search();
|
||||
|
||||
////////////////////////////////////////////////////////////////////////
|
||||
// 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;
|
||||
}
|
||||
|
||||
dme.search();
|
||||
xponder.search();
|
||||
|
||||
////////////////////////////////////////////////////////////////////////
|
||||
// Beacons.
|
||||
|
@ -440,7 +308,4 @@ void FGRadioStack::search()
|
|||
#endif
|
||||
}
|
||||
last_beacon = beacon_type;
|
||||
|
||||
adf.search();
|
||||
xponder.search();
|
||||
}
|
||||
|
|
|
@ -38,10 +38,12 @@
|
|||
#include <Sound/beacon.hxx>
|
||||
#include <Sound/morse.hxx>
|
||||
|
||||
#include "dme.hxx"
|
||||
#include "kr_87.hxx" // ADF
|
||||
#include "kt_70.hxx" // Transponder
|
||||
#include "navcom.hxx"
|
||||
|
||||
|
||||
class FGRadioStack : public FGSubsystem
|
||||
{
|
||||
FGBeacon beacon;
|
||||
|
@ -58,24 +60,6 @@ class FGRadioStack : public FGSubsystem
|
|||
|
||||
bool need_update;
|
||||
|
||||
bool dme_valid;
|
||||
int dme_switch_pos;
|
||||
bool dme_inrange;
|
||||
double dme_freq;
|
||||
double dme_lon;
|
||||
double dme_lat;
|
||||
double dme_elev;
|
||||
double dme_range;
|
||||
double dme_effective_range;
|
||||
double dme_x;
|
||||
double dme_y;
|
||||
double dme_z;
|
||||
double dme_dist;
|
||||
double dme_prev_dist;
|
||||
double dme_spd;
|
||||
double dme_ete;
|
||||
SGTimeStamp dme_last_time;
|
||||
|
||||
bool outer_marker;
|
||||
bool middle_marker;
|
||||
bool inner_marker;
|
||||
|
@ -85,6 +69,7 @@ class FGRadioStack : public FGSubsystem
|
|||
bool middle_blink;
|
||||
bool inner_blink;
|
||||
|
||||
FGDME dme;
|
||||
FGKR_87 adf; // King KR 87 Digital ADF model
|
||||
FGKT_70 xponder; // Bendix/King KT 70 Panel-Mounted Transponder
|
||||
FGNavCom navcom1;
|
||||
|
@ -106,29 +91,10 @@ public:
|
|||
inline FGNavCom *get_navcom1() { return &navcom1; }
|
||||
inline FGNavCom *get_navcom2() { return &navcom2; }
|
||||
|
||||
// DME Setters
|
||||
inline void set_dme_freq (double freq) {
|
||||
dme_freq = freq; need_update = true;
|
||||
}
|
||||
|
||||
|
||||
// DME Accessors
|
||||
inline bool dme_has_power() const {
|
||||
return (dme_switch_pos == 1 || dme_switch_pos == 3)
|
||||
&& (dme_bus_power->getDoubleValue() > 1.0);
|
||||
}
|
||||
inline double get_dme_freq () const { return dme_freq; }
|
||||
|
||||
// Marker Beacon Accessors
|
||||
inline bool get_inner_blink () const { return inner_blink; }
|
||||
inline bool get_middle_blink () const { return middle_blink; }
|
||||
inline bool get_outer_blink () const { return outer_blink; }
|
||||
|
||||
// Calculated values.
|
||||
inline bool get_dme_inrange () const { return dme_inrange; }
|
||||
inline double get_dme_dist () const { return dme_dist; }
|
||||
inline double get_dme_spd () const { return dme_spd; }
|
||||
inline double get_dme_ete () const { return dme_ete; }
|
||||
};
|
||||
|
||||
|
||||
|
|
Loading…
Add table
Reference in a new issue