X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FInstrumentation%2Fadf.cxx;h=62302c92bd97b2d4a5416c4ee7c09b6fed91eb51;hb=6b9aa0fb970e90aaf8d6800b77b3abe84ae9906d;hp=36d9f0b975624cbe61f53ea45aa66d4030dc2aad;hpb=0b9adf8854398461333eba43df18fa2f5c8231a1;p=flightgear.git diff --git a/src/Instrumentation/adf.cxx b/src/Instrumentation/adf.cxx index 36d9f0b97..62302c92b 100644 --- a/src/Instrumentation/adf.cxx +++ b/src/Instrumentation/adf.cxx @@ -18,12 +18,13 @@ #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. @@ -105,9 +106,6 @@ ADF::init () // foreign simulator properties _electrical_node = fgGetNode("/systems/electrical/outputs/adf", 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); // backward compatibility check @@ -153,18 +151,12 @@ 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 (!_transmitter_valid) { _in_range_node->setBoolValue(false); @@ -173,12 +165,11 @@ ADF::update (double delta_time_sec) } // 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) { @@ -186,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) @@ -233,16 +225,14 @@ ADF::update (double delta_time_sec) } 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 ) {