X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FInstrumentation%2Fadf.cxx;h=62302c92bd97b2d4a5416c4ee7c09b6fed91eb51;hb=6b9aa0fb970e90aaf8d6800b77b3abe84ae9906d;hp=6da2a2ed40d1614d8f01386d6d3b3a1e0bd7fee1;hpb=c1bb4aec97f0ae8e6bbe970acfd1a5f53127a723;p=flightgear.git diff --git a/src/Instrumentation/adf.cxx b/src/Instrumentation/adf.cxx index 6da2a2ed4..62302c92b 100644 --- a/src/Instrumentation/adf.cxx +++ b/src/Instrumentation/adf.cxx @@ -17,11 +17,14 @@ #include #include "adf.hxx" +#include +#include #include #include #include +using std::string; // Use a bigger number to be more responsive, or a smaller number // to be more sluggish. @@ -83,31 +86,37 @@ ADF::init () { string branch; branch = "/instrumentation/" + _name; - SGPropertyNode *node = fgGetNode(branch.c_str(), _num, true ); - _longitude_node = fgGetNode("/position/longitude-deg", true); - _latitude_node = fgGetNode("/position/latitude-deg", true); - _altitude_node = fgGetNode("/position/altitude-ft", true); - _heading_node = fgGetNode("/orientation/heading-deg", true); - _serviceable_node = node->getChild("serviceable", 0, true); - _error_node = node->getChild("error-deg", 0, true); - _electrical_node = fgGetNode("/systems/electrical/outputs/adf", true); - branch = branch + "/frequencies"; - SGPropertyNode *fnode = node->getChild("frequencies", 0, true); - _frequency_node = fnode->getChild("selected-khz", 0, true); - _mode_node = node->getChild("mode", 0, true); - _volume_node = node->getChild("volume-norm", 0, true); - _in_range_node = node->getChild("in-range", 0, true); - _bearing_node = node->getChild("indicated-bearing-deg", 0, true); - _ident_node = node->getChild("ident", 0, true); + + // instrument properties + _error_node = node->getChild("error-deg", 0, true); + _mode_node = node->getChild("mode", 0, true); + _volume_node = node->getChild("volume-norm", 0, true); + _in_range_node = node->getChild("in-range", 0, true); + _bearing_node = node->getChild("indicated-bearing-deg", 0, true); + _ident_node = node->getChild("ident", 0, true); _ident_audible_node = node->getChild("ident-audible", 0, true); + _serviceable_node = node->getChild("serviceable", 0, true); + _power_btn_node = node->getChild("power-btn", 0, true); + _operable_node = node->getChild("operable", 0, true); + + // frequency properties + SGPropertyNode *fnode = node->getChild("frequencies", 0, true); + _frequency_node = fnode->getChild("selected-khz", 0, true); + // foreign simulator properties + _electrical_node = fgGetNode("/systems/electrical/outputs/adf", true); + _heading_node = fgGetNode("/orientation/heading-deg", true); + + // backward compatibility check + if (_power_btn_node->getType() == simgear::props::NONE) + _power_btn_node->setBoolValue(true); // front end didn't implement a power button + + // sound support (audible ident code) SGSoundMgr *smgr = globals->get_soundmgr(); _sgr = smgr->find("avionics", true); _sgr->tie_to_listener(); - morse.init(); - std::ostringstream temp; temp << _name << _num; _adf_ident = temp.str(); @@ -117,13 +126,24 @@ void ADF::update (double delta_time_sec) { // If it's off, don't waste any time. - if (_electrical_node->getDoubleValue() < 1.0 - || !_serviceable_node->getBoolValue()) { - set_bearing(delta_time_sec, 90); + if (_electrical_node->getDoubleValue() < 8.0 + || !_serviceable_node->getBoolValue() + || !_power_btn_node->getBoolValue() ) { + _in_range_node->setBoolValue(false); + _operable_node->setBoolValue(false); _ident_node->setStringValue(""); return; } + _operable_node->setBoolValue(true); + + string mode = _mode_node->getStringValue(); + if (mode == "ant" || mode == "test") set_bearing(delta_time_sec, 90); + if (mode != "bfo" && mode != "adf") { + _in_range_node->setBoolValue(false); + _ident_node->setStringValue(""); + return; + } // Get the frequency int frequency_khz = _frequency_node->getIntValue(); if (frequency_khz != _last_frequency_khz) { @@ -131,35 +151,25 @@ ADF::update (double delta_time_sec) _last_frequency_khz = frequency_khz; } - // Get the aircraft position - double longitude_deg = _longitude_node->getDoubleValue(); - double latitude_deg = _latitude_node->getDoubleValue(); - double altitude_m = _altitude_node->getDoubleValue(); - - double longitude_rad = longitude_deg * SGD_DEGREES_TO_RADIANS; - double latitude_rad = latitude_deg * SGD_DEGREES_TO_RADIANS; - + SGGeod acPos(globals->get_aircraft_position()); + // On timeout, scan again _time_before_search_sec -= delta_time_sec; if (_time_before_search_sec < 0) - search(frequency_khz, longitude_rad, latitude_rad, altitude_m); + search(frequency_khz, acPos); - // If it's off, don't bother. - string mode = _mode_node->getStringValue(); - if (!_transmitter_valid || (mode != "bfo" && mode != "adf")) - { - set_bearing(delta_time_sec, 90); + if (!_transmitter_valid) { + _in_range_node->setBoolValue(false); _ident_node->setStringValue(""); return; } // Calculate the bearing to the transmitter - SGGeod geod = SGGeod::fromRadM(longitude_rad, latitude_rad, altitude_m); - SGVec3d location = SGVec3d::fromGeod(geod); + SGVec3d location = globals->get_aircraft_position_cart(); double distance_nm = dist(_transmitter_cart, location) * SG_METER_TO_NM; double range_nm = adjust_range(_transmitter_pos.getElevationFt(), - altitude_m * SG_METER_TO_FEET, + acPos.getElevationFt(), _transmitter_range_nm); if (distance_nm <= range_nm) { @@ -167,9 +177,10 @@ ADF::update (double delta_time_sec) double bearing, az2, s; double heading = _heading_node->getDoubleValue(); - geo_inverse_wgs_84(geod, _transmitter_pos, + geo_inverse_wgs_84(acPos, _transmitter_pos, &bearing, &az2, &s); _in_range_node->setBoolValue(true); + _ident_node->setStringValue(_last_ident); bearing -= heading; if (bearing < 0) @@ -191,7 +202,7 @@ ADF::update (double delta_time_sec) if ( sound != NULL ) sound->set_volume( volume ); else - SG_LOG( SG_GENERAL, SG_ALERT, "Can't find adf-ident sound" ); + SG_LOG( SG_INSTR, SG_ALERT, "Can't find adf-ident sound" ); } time_t cur_time = globals->get_time_params()->get_cur_time(); @@ -208,23 +219,20 @@ ADF::update (double delta_time_sec) } } else { _in_range_node->setBoolValue(false); - set_bearing(delta_time_sec, 90); _ident_node->setStringValue(""); _sgr->stop( _adf_ident ); } } void -ADF::search (double frequency_khz, double longitude_rad, - double latitude_rad, double altitude_m) +ADF::search (double frequency_khz, const SGGeod& pos) { string ident = ""; // reset search time _time_before_search_sec = 1.0; - // try the ILS list first - FGNavRecord *nav = globals->get_navlist()->findByFreq(frequency_khz, - SGGeod::fromRadM(longitude_rad, latitude_rad, altitude_m)); + FGNavList::TypeFilter filter(FGPositioned::NDB); + FGNavRecord *nav = FGNavList::findByFreq(frequency_khz, pos, &filter); _transmitter_valid = (nav != NULL); if ( _transmitter_valid ) { @@ -247,7 +255,7 @@ ADF::search (double frequency_khz, double longitude_rad, } SGSoundSample *sound; - sound = morse.make_ident( ident, LO_FREQUENCY ); + sound = FGMorse::instance()->make_ident( ident, FGMorse::LO_FREQUENCY ); sound->set_volume(_last_volume = 0); _sgr->add( sound, _adf_ident );