X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FCockpit%2Fkr_87.cxx;h=9c06f9a491968290c22d87464032793af1e714c6;hb=8cc7b283d54d10150ad0883e96fd05ce020e7ed8;hp=828ebd3d646c206f93eadcd9419a25397948fe50;hpb=fa6ad91fdeae2b6605a9a2d70721a24247915874;p=flightgear.git diff --git a/src/Cockpit/kr_87.cxx b/src/Cockpit/kr_87.cxx index 828ebd3d6..9c06f9a49 100644 --- a/src/Cockpit/kr_87.cxx +++ b/src/Cockpit/kr_87.cxx @@ -56,10 +56,10 @@ static double kludgeRange ( double stationElev, double aircraftElev, double range = fabs(nominalRange * factor); // Clamp the range to keep it sane; for - // now, never less than 25% or more than + // now, never less than 50% or more than // 500% of nominal range. - if (range < nominalRange/4.0) { - range = nominalRange/4.0; + if (range < nominalRange/2.0) { + range = nominalRange/2.0; } else if (range > nominalRange*5.0) { range = nominalRange*5.0; } @@ -73,12 +73,24 @@ FGKR_87::FGKR_87() : 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/adf", true)), + servicable(fgGetNode("/instrumentation/adf/servicable", true)), need_update(true), valid(false), - freq(0.0), - stby_freq(0.0), - on_off_vol_btn(0.0), - adf_btn(false), + inrange(false), + dist(0.0), + heading(0.0), + goal_needle_deg(0.0), + et_flash_time(0.0), + ant_mode(0), + stby_mode(0), + timer_mode(0), + count_mode(0), + rotation(0), + power_btn(true), + audio_btn(true), + vol_btn(0.5), + adf_btn(true), bfo_btn(false), frq_btn(false), last_frq_btn(false), @@ -86,135 +98,150 @@ FGKR_87::FGKR_87() : last_flt_et_btn(false), set_rst_btn(false), last_set_rst_btn(false), - goal_needle_deg(0.0), + freq(0.0), + stby_freq(0.0), needle_deg(0.0), flight_timer(0.0), elapsed_timer(0.0), - tmp_timer(0.0), - ant_mode(0), - stby_mode(0), - timer_mode(0), - count_mode(0) + tmp_timer(0.0) { - SGPath path( globals->get_fg_root() ); - SGPath term = path; - term.append( "Navaids/range.term" ); - SGPath low = path; - low.append( "Navaids/range.low" ); - SGPath high = path; - high.append( "Navaids/range.high" ); - - term_tbl = new SGInterpTable( term.str() ); - low_tbl = new SGInterpTable( low.str() ); - high_tbl = new SGInterpTable( high.str() ); } // Destructor -FGKR_87::~FGKR_87() -{ - delete term_tbl; - delete low_tbl; - delete high_tbl; +FGKR_87::~FGKR_87() { } -void -FGKR_87::init () -{ +void FGKR_87::init () { + servicable->setBoolValue( true ); morse.init(); - - update(0); // FIXME: use dt } -void -FGKR_87::bind () -{ - // User inputs - fgTie("/radios/adf/frequencies/selected-khz", this, - &FGKR_87::get_freq, &FGKR_87::set_freq); - fgSetArchivable("/radios/adf/frequencies/selected-khz"); - fgTie("/radios/adf/frequencies/standby-khz", this, - &FGKR_87::get_stby_freq, &FGKR_87::set_stby_freq); - fgSetArchivable("/radios/adf/frequencies/standby-khz"); - fgTie("/radios/adf/rotation-deg", this, + +void FGKR_87::bind () { + // internal values + fgTie("/radios/kr-87/internal/valid", this, &FGKR_87::get_valid); + fgTie("/radios/kr-87/internal/inrange", this, &FGKR_87::get_inrange); + fgTie("/radios/kr-87/internal/dist", this, &FGKR_87::get_dist); + fgTie("/radios/kr-87/internal/heading", this, &FGKR_87::get_heading); + + // modes + fgTie("/radios/kr-87/modes/ant", this, + &FGKR_87::get_ant_mode); + fgTie("/radios/kr-87/modes/stby", this, + &FGKR_87::get_stby_mode); + fgTie("/radios/kr-87/modes/timer", this, + &FGKR_87::get_timer_mode); + fgTie("/radios/kr-87/modes/count", this, + &FGKR_87::get_count_mode); + + // input and buttons + fgTie("/radios/kr-87/inputs/rotation-deg", this, &FGKR_87::get_rotation, &FGKR_87::set_rotation); - fgSetArchivable("/radios/adf/rotation-deg"); - fgTie("/radios/adf/needle-deg", this, - &FGKR_87::get_needle_deg); - fgTie("/radios/adf/on-off-volume", this, - &FGKR_87::get_on_off_vol_btn, - &FGKR_87::set_on_off_vol_btn); - fgSetArchivable("/radios/adf/on-off-volume"); - fgTie("/radios/adf/adf-btn", this, + fgSetArchivable("/radios/kr-87/inputs/rotation-deg"); + fgTie("/radios/kr-87/inputs/power-btn", this, + &FGKR_87::get_power_btn, + &FGKR_87::set_power_btn); + fgSetArchivable("/radios/kr-87/inputs/power-btn"); + fgTie("/radios/kr-87/inputs/audio-btn", this, + &FGKR_87::get_audio_btn, + &FGKR_87::set_audio_btn); + fgSetArchivable("/radios/kr-87/inputs/audio-btn"); + fgTie("/radios/kr-87/inputs/volume", this, + &FGKR_87::get_vol_btn, + &FGKR_87::set_vol_btn); + fgSetArchivable("/radios/kr-87/inputs/volume"); + fgTie("/radios/kr-87/inputs/adf-btn", this, &FGKR_87::get_adf_btn, &FGKR_87::set_adf_btn); - fgTie("/radios/adf/bfo-btn", this, + fgTie("/radios/kr-87/inputs/bfo-btn", this, &FGKR_87::get_bfo_btn, &FGKR_87::set_bfo_btn); - fgTie("/radios/adf/frq-btn", this, + fgTie("/radios/kr-87/inputs/frq-btn", this, &FGKR_87::get_frq_btn, &FGKR_87::set_frq_btn); - fgTie("/radios/adf/flt-et-btn", this, + fgTie("/radios/kr-87/inputs/flt-et-btn", this, &FGKR_87::get_flt_et_btn, &FGKR_87::set_flt_et_btn); - fgTie("/radios/adf/set-rst-btn", this, + fgTie("/radios/kr-87/inputs/set-rst-btn", this, &FGKR_87::get_set_rst_btn, &FGKR_87::set_set_rst_btn); - fgTie("/radios/adf/stby-mode", this, - &FGKR_87::get_stby_mode); - fgTie("/radios/adf/timer-mode", this, - &FGKR_87::get_timer_mode); - fgTie("/radios/adf/count-mode", this, - &FGKR_87::get_count_mode); - fgTie("/radios/adf/ident", this, - &FGKR_87::get_ident_btn, - &FGKR_87::set_ident_btn); - fgSetArchivable("/radios/adf/ident"); - - // calculated values - fgTie("/radios/adf/inrange", this, &FGKR_87::get_inrange); - fgTie("/radios/adf/heading", this, &FGKR_87::get_heading); - fgTie("/radios/adf/flight-timer", this, &FGKR_87::get_flight_timer); - fgTie("/radios/adf/elapsed-timer", this, + + // outputs + fgTie("/radios/kr-87/outputs/selected-khz", this, + &FGKR_87::get_freq, &FGKR_87::set_freq); + fgSetArchivable("/radios/kr-87/outputs/selected-khz"); + fgTie("/radios/kr-87/outputs/standby-khz", this, + &FGKR_87::get_stby_freq, &FGKR_87::set_stby_freq); + fgSetArchivable("/radios/kr-87/outputs/standby-khz"); + fgTie("/radios/kr-87/outputs/needle-deg", this, + &FGKR_87::get_needle_deg); + fgTie("/radios/kr-87/outputs/flight-timer", this, &FGKR_87::get_flight_timer); + fgTie("/radios/kr-87/outputs/elapsed-timer", this, &FGKR_87::get_elapsed_timer, &FGKR_87::set_elapsed_timer); + + // annunciators + fgTie("/radios/kr-87/annunciators/ant", this, &FGKR_87::get_ant_ann ); + fgTie("/radios/kr-87/annunciators/adf", this, &FGKR_87::get_adf_ann ); + fgTie("/radios/kr-87/annunciators/bfo", this, &FGKR_87::get_bfo_ann ); + fgTie("/radios/kr-87/annunciators/frq", this, &FGKR_87::get_frq_ann ); + fgTie("/radios/kr-87/annunciators/flt", this, &FGKR_87::get_flt_ann ); + fgTie("/radios/kr-87/annunciators/et", this, &FGKR_87::get_et_ann ); } -void -FGKR_87::unbind () -{ - fgUntie("/radios/adf/frequencies/selected-khz"); - fgUntie("/radios/adf/frequencies/standby-khz"); - fgUntie("/radios/adf/rotation-deg"); - fgUntie("/radios/adf/needle-deg"); - fgUntie("/radios/adf/on-off-volume"); - fgUntie("/radios/adf/adf-btn"); - fgUntie("/radios/adf/bfo-btn"); - fgUntie("/radios/adf/frq-btn"); - fgUntie("/radios/adf/flt-et-btn"); - fgUntie("/radios/adf/set-rst-btn"); - fgUntie("/radios/adf/timer-mode"); - fgUntie("/radios/adf/count-mode"); - fgUntie("/radios/adf/ident"); - fgUntie("/radios/adf/inrange"); - fgUntie("/radios/adf/heading"); - fgUntie("/radios/adf/flight-timer"); - fgUntie("/radios/adf/elapsed-timer"); + +void FGKR_87::unbind () { + // internal values + fgUntie("/radios/kr-87/internal/valid"); + fgUntie("/radios/kr-87/internal/inrange"); + fgUntie("/radios/kr-87/internal/dist"); + fgUntie("/radios/kr-87/internal/heading"); + + // modes + fgUntie("/radios/kr-87/modes/ant"); + fgUntie("/radios/kr-87/modes/stby"); + fgUntie("/radios/kr-87/modes/timer"); + fgUntie("/radios/kr-87/modes/count"); + + // input and buttons + fgUntie("/radios/kr-87/inputs/rotation-deg"); + fgUntie("/radios/kr-87/inputs/power-btn"); + fgUntie("/radios/kr-87/inputs/volume"); + fgUntie("/radios/kr-87/inputs/adf-btn"); + fgUntie("/radios/kr-87/inputs/bfo-btn"); + fgUntie("/radios/kr-87/inputs/frq-btn"); + fgUntie("/radios/kr-87/inputs/flt-et-btn"); + fgUntie("/radios/kr-87/inputs/set-rst-btn"); + fgUntie("/radios/kr-87/inputs/ident-btn"); + + // outputs + fgUntie("/radios/kr-87/outputs/selected-khz"); + fgUntie("/radios/kr-87/outputs/standby-khz"); + fgUntie("/radios/kr-87/outputs/needle-deg"); + fgUntie("/radios/kr-87/outputs/flight-timer"); + fgUntie("/radios/kr-87/outputs/elapsed-timer"); + + // annunciators + fgUntie("/radios/kr-87/annunciators/ant"); + fgUntie("/radios/kr-87/annunciators/adf"); + fgUntie("/radios/kr-87/annunciators/bfo"); + fgUntie("/radios/kr-87/annunciators/frq"); + fgUntie("/radios/kr-87/annunciators/flt"); + fgUntie("/radios/kr-87/annunciators/et"); } // Update the various nav values based on position and valid tuned in navs -void -FGKR_87::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; +void FGKR_87::update( double dt ) { + double acft_lon = lon_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS; + double acft_lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS; + double acft_elev = alt_node->getDoubleValue() * SG_FEET_TO_METER; need_update = false; - Point3D aircraft = sgGeodToCart( Point3D( lon, lat, elev ) ); + Point3D aircraft = sgGeodToCart( Point3D( acft_lon, acft_lat, acft_elev ) ); Point3D station; double az1, az2, s; @@ -222,7 +249,7 @@ FGKR_87::update(double dt) // Radio //////////////////////////////////////////////////////////////////////// - if ( on_off_vol_btn >= 0.01 ) { + if ( has_power() && servicable->getBoolValue() ) { // buttons if ( adf_btn == 0 ) { ant_mode = 1; @@ -258,15 +285,19 @@ FGKR_87::update(double dt) // button depressed and was last iteration too tmp_timer += dt; cout << "tmp_timer = " << tmp_timer << endl; - } - if ( set_rst_btn == 0 && set_rst_btn != last_set_rst_btn ) { - // button released if ( tmp_timer > 2.0 ) { // button held depressed for 2 seconds cout << "entering elapsed count down mode" << endl; timer_mode = 1; count_mode = 2; elapsed_timer = 0.0; + } + } + if ( set_rst_btn == 0 && set_rst_btn != last_set_rst_btn ) { + // button released + if ( tmp_timer > 2.0 ) { + // button held depressed for 2 seconds, don't adjust + // mode, just exit } else if ( count_mode == 2 ) { count_mode = 1; } else { @@ -292,21 +323,41 @@ FGKR_87::update(double dt) } } + // annunciators + ant_ann = adf_btn; + adf_ann = !adf_btn; + bfo_ann = bfo_btn; + frq_ann = !stby_mode; + flt_ann = stby_mode && !timer_mode; + if ( count_mode < 2 ) { + et_ann = stby_mode && timer_mode; + } else { + et_flash_time += dt; + if ( et_ann && et_flash_time > 0.5 ) { + et_ann = false; + et_flash_time -= 0.5; + } else if ( !et_ann && et_flash_time > 0.2 ) { + et_ann = true; + et_flash_time -= 0.2; + } + } + if ( valid ) { // staightline distance station = Point3D( x, y, z ); dist = aircraft.distance3D( station ); // wgs84 heading - geo_inverse_wgs_84( elev, lat * SGD_RADIANS_TO_DEGREES, - lon * SGD_RADIANS_TO_DEGREES, - lat, lon, + geo_inverse_wgs_84( acft_elev, + acft_lat * SGD_RADIANS_TO_DEGREES, + acft_lon * SGD_RADIANS_TO_DEGREES, + stn_lat, stn_lon, &az1, &az2, &s ); heading = az1; // cout << " heading = " << heading // << " dist = " << dist << endl; - effective_range = kludgeRange(elev, elev, range); + effective_range = kludgeRange(stn_elev, acft_elev, range); if ( dist < effective_range * SG_NM_TO_METER ) { inrange = true; } else if ( dist < 2 * effective_range * SG_NM_TO_METER ) { @@ -329,26 +380,79 @@ FGKR_87::update(double dt) goal_needle_deg = 90.0; } } else { + // unit turned off goal_needle_deg = 0.0; flight_timer = 0.0; elapsed_timer = 0.0; + ant_ann = false; + adf_ann = false; + bfo_ann = false; + frq_ann = false; + flt_ann = false; + et_ann = false; + } + + // formatted timer + double time; + int hours, min, sec; + if ( timer_mode == 0 ) { + time = flight_timer; + } else { + time = elapsed_timer; + } + // cout << time << endl; + hours = (int)(time / 3600.0); + time -= hours * 3600.00; + min = (int)(time / 60.0); + time -= min * 60.0; + sec = (int)time; + int big, little; + if ( hours > 0 ) { + big = hours; + if ( big > 99 ) { + big = 99; + } + little = min; + } else { + big = min; + little = sec; + } + if ( big > 99 ) { + big = 99; } + char formatted_timer[128]; + // cout << big << ":" << little << endl; + snprintf(formatted_timer, 6, "%02d:%02d", big, little); + fgSetString( "/radios/kr-87/outputs/timer-string", formatted_timer ); + + while ( goal_needle_deg < 0.0 ) { goal_needle_deg += 360.0; } + while ( goal_needle_deg >= 360.0 ) { goal_needle_deg -= 360.0; } double diff = goal_needle_deg - needle_deg; + while ( diff < -180.0 ) { diff += 360.0; } + while ( diff > 180.0 ) { diff -= 360.0; } + needle_deg += diff * dt * 4; + while ( needle_deg < 0.0 ) { needle_deg += 360.0; } + while ( needle_deg >= 360.0 ) { needle_deg -= 360.0; } + // cout << "goal = " << goal_needle_deg << " actual = " << needle_deg + // << endl; // cout << "flt = " << flight_timer << " et = " << elapsed_timer // << " needle = " << needle_deg << endl; -#ifdef ENABLE_AUDIO_SUPPORT - if ( valid && inrange ) { - // play station ident via audio system if on + ident, + if ( valid && inrange && servicable->getBoolValue() ) { + // play station ident via audio system if on + ant mode, // otherwise turn it off - if ( on_off_vol_btn >= 0.01 && ident_btn ) { + if ( vol_btn >= 0.01 && audio_btn ) { FGSimpleSound *sound; sound = globals->get_soundmgr()->find( "adf-ident" ); if ( sound != NULL ) { - sound->set_volume( on_off_vol_btn ); + if ( !adf_btn ) { + sound->set_volume( vol_btn ); + } else { + sound->set_volume( vol_btn / 4.0 ); + } } else { SG_LOG( SG_COCKPIT, SG_ALERT, "Can't find adf-ident sound" ); } @@ -368,47 +472,45 @@ FGKR_87::update(double dt) globals->get_soundmgr()->stop( "adf-ident" ); } } -#endif } // Update current nav/adf radio stations based on current postition -void FGKR_87::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; +void FGKR_87::search() { + double acft_lon = lon_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS; + double acft_lat = lat_node->getDoubleValue() * SGD_DEGREES_TO_RADIANS; + double acft_elev = alt_node->getDoubleValue() * SG_FEET_TO_METER; // FIXME: the panel should handle this - FGNav nav; - static string last_ident = ""; //////////////////////////////////////////////////////////////////////// // ADF. //////////////////////////////////////////////////////////////////////// - if ( current_navlist->query( lon, lat, elev, freq, &nav ) ) { + FGNav *nav + = current_navlist->findByFreq(freq, acft_lon, acft_lat, acft_elev); + + if ( nav != NULL ) { char sfreq[128]; snprintf( sfreq, 10, "%.0f", freq ); ident = sfreq; - ident += nav.get_ident(); - // cout << "adf ident = " << ident << endl; + ident += nav->get_ident(); + // cout << "adf ident = " << ident << endl; valid = true; if ( last_ident != ident ) { last_ident = ident; - trans_ident = nav.get_trans_ident(); - 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(); - -#ifdef ENABLE_AUDIO_SUPPORT + trans_ident = nav->get_trans_ident(); + stn_lon = nav->get_lon(); + stn_lat = nav->get_lat(); + stn_elev = nav->get_elev(); + range = nav->get_range(); + effective_range = kludgeRange(stn_elev, acft_elev, range); + x = nav->get_x(); + y = nav->get_y(); + z = nav->get_z(); + if ( globals->get_soundmgr()->exists( "adf-ident" ) ) { globals->get_soundmgr()->remove( "adf-ident" ); } @@ -425,18 +527,15 @@ void FGKR_87::search() // << play_count << " last_time = " // << last_time << " current time = " // << globals->get_time_params()->get_cur_time() << endl; -#endif // cout << "Found an adf station in range" << endl; - // cout << " id = " << nav.get_ident() << endl; + // cout << " id = " << nav->get_ident() << endl; } } else { valid = false; ident = ""; trans_ident = ""; -#ifdef ENABLE_AUDIO_SUPPORT globals->get_soundmgr()->remove( "adf-ident" ); -#endif last_ident = ""; // cout << "not picking up adf. :-(" << endl; }