X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FCockpit%2Fkr_87.cxx;h=67a0586dbf341ae13d53f58ab928e8525f079cc2;hb=f38c88b762bc6c317669e8e0b00a92b09ee4671a;hp=5e74c18c119784cf40c3502e4c87feff8c83b816;hpb=aef1876858022e6e37bfed326d225b9afee96728;p=flightgear.git diff --git a/src/Cockpit/kr_87.cxx b/src/Cockpit/kr_87.cxx index 5e74c18c1..67a0586db 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,22 @@ 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)), 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), + vol_btn(0.5), + adf_btn(true), bfo_btn(false), frq_btn(false), last_frq_btn(false), @@ -86,128 +96,141 @@ FGKR_87::FGKR_87() : last_flt_et_btn(false), set_rst_btn(false), last_set_rst_btn(false), - goal_needle_deg(0.0), + ident_btn(false), + 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 () { 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/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, + fgTie("/radios/kr-87/inputs/ident-btn", this, + &FGKR_87::get_ident_btn, &FGKR_87::set_ident_btn); + + // 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) -{ +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 +245,7 @@ FGKR_87::update(double dt) // Radio //////////////////////////////////////////////////////////////////////// - if ( on_off_vol_btn >= 0.01 ) { + if ( has_power() ) { // buttons if ( adf_btn == 0 ) { ant_mode = 1; @@ -258,15 +281,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,6 +319,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 ); @@ -330,29 +376,76 @@ 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; } - cout << "goal = " << goal_needle_deg << "actual = " << needle_deg << endl; 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, + // play station ident via audio system if on + ident_btn, // otherwise turn it off - if ( on_off_vol_btn >= 0.01 && ident_btn ) { + if ( vol_btn >= 0.01 && ident_btn ) { FGSimpleSound *sound; sound = globals->get_soundmgr()->find( "adf-ident" ); if ( sound != NULL ) { - sound->set_volume( on_off_vol_btn ); + sound->set_volume( vol_btn ); } else { SG_LOG( SG_COCKPIT, SG_ALERT, "Can't find adf-ident sound" ); } @@ -377,8 +470,7 @@ FGKR_87::update(double dt) // 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; @@ -397,7 +489,7 @@ void FGKR_87::search() snprintf( sfreq, 10, "%.0f", freq ); ident = sfreq; ident += nav.get_ident(); - cout << "adf ident = " << ident << endl; +// cout << "adf ident = " << ident << endl; valid = true; if ( last_ident != ident ) { last_ident = ident;