X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FInstrumentation%2Fadf.cxx;h=62302c92bd97b2d4a5416c4ee7c09b6fed91eb51;hb=6b9aa0fb970e90aaf8d6800b77b3abe84ae9906d;hp=c1865da34f603dc1b658509d3ad0fd9ea707daa1;hpb=78e6d359988861b1acb9450a84d2e384e8777978;p=flightgear.git diff --git a/src/Instrumentation/adf.cxx b/src/Instrumentation/adf.cxx index c1865da34..62302c92b 100644 --- a/src/Instrumentation/adf.cxx +++ b/src/Instrumentation/adf.cxx @@ -3,16 +3,28 @@ // // This file is in the Public Domain and comes with no warranty. +#ifdef HAVE_CONFIG_H +# include +#endif + #include #include #include +#include #include
#include
#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. @@ -48,12 +60,20 @@ adjust_range (double transmitter_elevation_ft, double aircraft_altitude_ft, } -ADF::ADF () - : _time_before_search_sec(0), - _last_frequency_khz(-1), - _transmitter_valid(false), - _transmitter_elevation_ft(0), - _transmitter_range_nm(0) +ADF::ADF (SGPropertyNode *node ) + : + _name(node->getStringValue("name", "adf")), + _num(node->getIntValue("number", 0)), + _time_before_search_sec(0), + _last_frequency_khz(-1), + _transmitter_valid(false), + _transmitter_pos(SGGeod::fromDeg(0, 0)), + _transmitter_cart(0, 0, 0), + _transmitter_range_nm(0), + _ident_count(0), + _last_ident_time(0), + _last_volume(-1), + _sgr(0) { } @@ -64,34 +84,66 @@ ADF::~ADF () void ADF::init () { - _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 = fgGetNode("/instrumentation/adf/serviceable", true); - _error_node = fgGetNode("/instrumentation/adf/error-deg", true); - _electrical_node = fgGetNode("/systems/electrical/outputs/adf", true); - _frequency_node = - fgGetNode("/instrumentation/adf/frequencies/selected-khz", true); - _mode_node = fgGetNode("/instrumentation/adf/mode", true); - - _in_range_node = fgGetNode("/instrumentation/adf/in-range", true); - _bearing_node = - fgGetNode("/instrumentation/adf/indicated-bearing-deg", true); - _ident_node = fgGetNode("/instrumentation/adf/ident", true); + string branch; + branch = "/instrumentation/" + _name; + SGPropertyNode *node = fgGetNode(branch.c_str(), _num, 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(); + + std::ostringstream temp; + temp << _name << _num; + _adf_ident = temp.str(); } void ADF::update (double delta_time_sec) { // If it's off, don't waste any time. - if (!_electrical_node->getBoolValue() || - !_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) { @@ -99,89 +151,119 @@ 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 - Point3D location = - sgGeodToCart(Point3D(longitude_rad, latitude_rad, altitude_m)); - - double distance_nm = _transmitter.distance3D(location) * SG_METER_TO_NM; - double range_nm = adjust_range(_transmitter_elevation_ft, - altitude_m * SG_METER_TO_FEET, + 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(), + acPos.getElevationFt(), _transmitter_range_nm); + if (distance_nm <= range_nm) { double bearing, az2, s; double heading = _heading_node->getDoubleValue(); - geo_inverse_wgs_84(altitude_m, - latitude_deg, - longitude_deg, - _transmitter_lat_deg, - _transmitter_lon_deg, + 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) bearing += 360; set_bearing(delta_time_sec, bearing); + + // adf ident sound + float volume; + if ( _ident_audible_node->getBoolValue() ) + volume = _volume_node->getFloatValue(); + else + volume = 0.0; + + if ( volume != _last_volume ) { + _last_volume = volume; + + SGSoundSample *sound; + sound = _sgr->find( _adf_ident ); + if ( sound != NULL ) + sound->set_volume( volume ); + else + SG_LOG( SG_INSTR, SG_ALERT, "Can't find adf-ident sound" ); + } + + time_t cur_time = globals->get_time_params()->get_cur_time(); + if ( _last_ident_time < cur_time - 30 ) { + _last_ident_time = cur_time; + _ident_count = 0; + } + + if ( _ident_count < 4 ) { + if ( !_sgr->is_playing(_adf_ident) && (volume > 0.05) ) { + _sgr->play_once( _adf_ident ); + ++_ident_count; + } + } } 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 - FGNav *nav = - globals->get_navlist()->findByFreq(frequency_khz, longitude_rad, - latitude_rad, altitude_m); + FGNavList::TypeFilter filter(FGPositioned::NDB); + FGNavRecord *nav = FGNavList::findByFreq(frequency_khz, pos, &filter); - if (nav !=0) { - _transmitter_valid = true; + _transmitter_valid = (nav != NULL); + if ( _transmitter_valid ) { ident = nav->get_trans_ident(); - if (ident !=_last_ident) { - _transmitter_lon_deg = nav->get_lon(); - _transmitter_lat_deg = nav->get_lat(); - _transmitter = Point3D(nav->get_x(), nav->get_y(), nav->get_z()); - _transmitter_elevation_ft = nav->get_elev_ft(); + if ( ident != _last_ident ) { + _transmitter_pos = nav->geod(); + _transmitter_cart = nav->cart(); _transmitter_range_nm = nav->get_range(); } - } else { - _transmitter_valid = false; } - _last_ident = ident; - _ident_node->setStringValue(ident.c_str()); + + if ( _last_ident != ident ) { + _last_ident = ident; + _ident_node->setStringValue(ident.c_str()); + + if ( _sgr->exists( _adf_ident ) ) { + // stop is required! -- remove alone wouldn't stop immediately + _sgr->stop( _adf_ident ); + _sgr->remove( _adf_ident ); + } + + SGSoundSample *sound; + sound = FGMorse::instance()->make_ident( ident, FGMorse::LO_FREQUENCY ); + sound->set_volume(_last_volume = 0); + _sgr->add( sound, _adf_ident ); + + int offset = (int)(sg_random() * 30.0); + _ident_count = offset / 4; + _last_ident_time = globals->get_time_params()->get_cur_time() - + offset; + } } void @@ -189,13 +271,11 @@ ADF::set_bearing (double dt, double bearing_deg) { double old_bearing_deg = _bearing_node->getDoubleValue(); - bearing_deg += _error_node->getDoubleValue(); - while ((bearing_deg - old_bearing_deg) >= 180) old_bearing_deg += 360; while ((bearing_deg - old_bearing_deg) <= -180) old_bearing_deg -= 360; - + bearing_deg += _error_node->getDoubleValue(); bearing_deg = fgGetLowPass(old_bearing_deg, bearing_deg, dt * RESPONSIVENESS);