X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FCockpit%2Fkr_87.cxx;h=9c06f9a491968290c22d87464032793af1e714c6;hb=8cc7b283d54d10150ad0883e96fd05ce020e7ed8;hp=3a70ce007f66033d960c65a63aa562698c0c6a32;hpb=24d14dd421cd0bd364a46f5e7e01416b00930994;p=flightgear.git diff --git a/src/Cockpit/kr_87.cxx b/src/Cockpit/kr_87.cxx index 3a70ce007..9c06f9a49 100644 --- a/src/Cockpit/kr_87.cxx +++ b/src/Cockpit/kr_87.cxx @@ -73,11 +73,23 @@ 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.5), + 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), @@ -86,128 +98,143 @@ 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/kr-87/frequencies/selected-khz", this, - &FGKR_87::get_freq, &FGKR_87::set_freq); - fgSetArchivable("/radios/kr-87/frequencies/selected-khz"); - fgTie("/radios/kr-87/frequencies/standby-khz", this, - &FGKR_87::get_stby_freq, &FGKR_87::set_stby_freq); - fgSetArchivable("/radios/kr-87/frequencies/standby-khz"); - fgTie("/radios/kr-87/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/kr-87/rotation-deg"); - fgTie("/radios/kr-87/needle-deg", this, - &FGKR_87::get_needle_deg); - fgTie("/radios/kr-87/on-off-volume", this, - &FGKR_87::get_on_off_vol_btn, - &FGKR_87::set_on_off_vol_btn); - fgSetArchivable("/radios/kr-87/on-off-volume"); - fgTie("/radios/kr-87/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/kr-87/bfo-btn", this, + fgTie("/radios/kr-87/inputs/bfo-btn", this, &FGKR_87::get_bfo_btn, &FGKR_87::set_bfo_btn); - fgTie("/radios/kr-87/frq-btn", this, + fgTie("/radios/kr-87/inputs/frq-btn", this, &FGKR_87::get_frq_btn, &FGKR_87::set_frq_btn); - fgTie("/radios/kr-87/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/kr-87/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/kr-87/stby-mode", this, - &FGKR_87::get_stby_mode); - fgTie("/radios/kr-87/timer-mode", this, - &FGKR_87::get_timer_mode); - fgTie("/radios/kr-87/count-mode", this, - &FGKR_87::get_count_mode); - fgTie("/radios/kr-87/ident", this, - &FGKR_87::get_ident_btn, - &FGKR_87::set_ident_btn); - fgSetArchivable("/radios/kr-87/ident"); - - // calculated values - fgTie("/radios/kr-87/inrange", this, &FGKR_87::get_inrange); - fgTie("/radios/kr-87/heading", this, &FGKR_87::get_heading); - fgTie("/radios/kr-87/flight-timer", this, &FGKR_87::get_flight_timer); - fgTie("/radios/kr-87/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/kr-87/frequencies/selected-khz"); - fgUntie("/radios/kr-87/frequencies/standby-khz"); - fgUntie("/radios/kr-87/rotation-deg"); - fgUntie("/radios/kr-87/needle-deg"); - fgUntie("/radios/kr-87/on-off-volume"); - fgUntie("/radios/kr-87/adf-btn"); - fgUntie("/radios/kr-87/bfo-btn"); - fgUntie("/radios/kr-87/frq-btn"); - fgUntie("/radios/kr-87/flt-et-btn"); - fgUntie("/radios/kr-87/set-rst-btn"); - fgUntie("/radios/kr-87/timer-mode"); - fgUntie("/radios/kr-87/count-mode"); - fgUntie("/radios/kr-87/ident"); - fgUntie("/radios/kr-87/inrange"); - fgUntie("/radios/kr-87/heading"); - fgUntie("/radios/kr-87/flight-timer"); - fgUntie("/radios/kr-87/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) -{ +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; @@ -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; @@ -296,6 +323,25 @@ 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 ); @@ -334,12 +380,51 @@ 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; } @@ -356,15 +441,18 @@ FGKR_87::update(double dt) // 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" ); } @@ -384,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() -{ +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( acft_lon, acft_lat, acft_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(); - stn_lon = nav.get_lon(); - stn_lat = nav.get_lat(); - stn_elev = nav.get_elev(); - range = nav.get_range(); + 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(); + x = nav->get_x(); + y = nav->get_y(); + z = nav->get_z(); -#ifdef ENABLE_AUDIO_SUPPORT if ( globals->get_soundmgr()->exists( "adf-ident" ) ) { globals->get_soundmgr()->remove( "adf-ident" ); } @@ -441,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; }