X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FInstrumentation%2Fadf.cxx;h=d2ac69145c262c2ff380aa3341c7643fdbc71a25;hb=86f462933d0d7130e4e688183976620ed2ddb5ae;hp=e6d02a1400dd0ce2fafa028ac52ab19c2d70e3e2;hpb=f614545fc5a6f0fb12a05344d9ee41b2a49cc04a;p=flightgear.git diff --git a/src/Instrumentation/adf.cxx b/src/Instrumentation/adf.cxx index e6d02a140..d2ac69145 100644 --- a/src/Instrumentation/adf.cxx +++ b/src/Instrumentation/adf.cxx @@ -3,9 +3,14 @@ // // This file is in the Public Domain and comes with no warranty. +#ifdef HAVE_CONFIG_H +# include +#endif + #include #include #include +#include #include
#include
@@ -54,47 +59,18 @@ adjust_range (double transmitter_elevation_ft, double aircraft_altitude_ft, 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_elevation_ft(0), + _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), - name("adf"), - num(0) -{ - int i; - for ( i = 0; i < node->nChildren(); ++i ) { - SGPropertyNode *child = node->getChild(i); - string cname = child->getName(); - string cval = child->getStringValue(); - if ( cname == "name" ) { - name = cval; - } else if ( cname == "number" ) { - num = child->getIntValue(); - } else { - SG_LOG( SG_AUTOPILOT, SG_WARN, "Error in adf config logic" ); - if ( name.length() ) { - SG_LOG( SG_AUTOPILOT, SG_WARN, "Section = " << name ); - } - } - } -} - - -ADF::ADF () - : _time_before_search_sec(0), - _last_frequency_khz(-1), - _transmitter_valid(false), - _transmitter_elevation_ft(0), - _transmitter_range_nm(0), - _ident_count(0), - _last_ident_time(0), - _last_volume(-1), - name("adf"), - num(0) + _sgr(0) { } @@ -106,9 +82,9 @@ void ADF::init () { string branch; - branch = "/instrumentation/" + name; + branch = "/instrumentation/" + _name; - SGPropertyNode *node = fgGetNode(branch.c_str(), num, true ); + 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); @@ -126,21 +102,22 @@ ADF::init () _ident_node = node->getChild("ident", 0, true); _ident_audible_node = node->getChild("ident-audible", 0, true); + SGSoundMgr *smgr = (SGSoundMgr *)globals->get_subsystem("soundmgr"); + _sgr = smgr->find("avionics", true); + morse.init(); std::ostringstream temp; - temp << name << num; - adf_ident = temp.str(); - - _serviceable_node->setBoolValue(true); + 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()) { + if (_electrical_node->getDoubleValue() < 1.0 + || !_serviceable_node->getBoolValue()) { set_bearing(delta_time_sec, 90); _ident_node->setStringValue(""); return; @@ -176,23 +153,20 @@ ADF::update (double delta_time_sec) } // 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, + SGGeod geod = SGGeod::fromRadM(longitude_rad, latitude_rad, altitude_m); + SGVec3d location = SGVec3d::fromGeod(geod); + + 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, _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(geod, _transmitter_pos, &bearing, &az2, &s); _in_range_node->setBoolValue(true); @@ -202,9 +176,9 @@ ADF::update (double delta_time_sec) set_bearing(delta_time_sec, bearing); // adf ident sound - double volume; + float volume; if ( _ident_audible_node->getBoolValue() ) - volume = _volume_node->getDoubleValue(); + volume = _volume_node->getFloatValue(); else volume = 0.0; @@ -212,7 +186,7 @@ ADF::update (double delta_time_sec) _last_volume = volume; SGSoundSample *sound; - sound = globals->get_soundmgr()->find( adf_ident ); + sound = _sgr->find( _adf_ident ); if ( sound != NULL ) sound->set_volume( volume ); else @@ -226,8 +200,8 @@ ADF::update (double delta_time_sec) } if ( _ident_count < 4 ) { - if ( !globals->get_soundmgr()->is_playing(adf_ident) ) { - globals->get_soundmgr()->play_once( adf_ident ); + if ( !_sgr->is_playing(_adf_ident) && (volume > 0.05) ) { + _sgr->play_once( _adf_ident ); ++_ident_count; } } @@ -235,7 +209,7 @@ ADF::update (double delta_time_sec) _in_range_node->setBoolValue(false); set_bearing(delta_time_sec, 90); _ident_node->setStringValue(""); - globals->get_soundmgr()->stop( adf_ident ); + _sgr->stop( _adf_ident ); } } @@ -248,18 +222,15 @@ ADF::search (double frequency_khz, double longitude_rad, _time_before_search_sec = 1.0; // try the ILS list first - FGNavRecord *nav = - globals->get_navlist()->findByFreq(frequency_khz, longitude_rad, - latitude_rad, altitude_m); + FGNavRecord *nav = globals->get_navlist()->findByFreq(frequency_khz, + SGGeod::fromRadM(longitude_rad, latitude_rad, altitude_m)); _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(); + _transmitter_pos = nav->geod(); + _transmitter_cart = nav->cart(); _transmitter_range_nm = nav->get_range(); } } @@ -268,16 +239,16 @@ ADF::search (double frequency_khz, double longitude_rad, _last_ident = ident; _ident_node->setStringValue(ident.c_str()); - if ( globals->get_soundmgr()->exists( adf_ident ) ) { + if ( _sgr->exists( _adf_ident ) ) { // stop is required! -- remove alone wouldn't stop immediately - globals->get_soundmgr()->stop( adf_ident ); - globals->get_soundmgr()->remove( adf_ident ); + _sgr->stop( _adf_ident ); + _sgr->remove( _adf_ident ); } SGSoundSample *sound; sound = morse.make_ident( ident, LO_FREQUENCY ); sound->set_volume(_last_volume = 0); - globals->get_soundmgr()->add( sound, adf_ident ); + _sgr->add( sound, _adf_ident ); int offset = (int)(sg_random() * 30.0); _ident_count = offset / 4; @@ -291,13 +262,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);