X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FCockpit%2Fkr_87.cxx;h=67a0586dbf341ae13d53f58ab928e8525f079cc2;hb=f38c88b762bc6c317669e8e0b00a92b09ee4671a;hp=19744ffe60b8493b3c2dd8ce304f18b4350b1dda;hpb=b3be31c5abaaa5c56c460e330b27149dc65fdbfe;p=flightgear.git diff --git a/src/Cockpit/kr_87.cxx b/src/Cockpit/kr_87.cxx index 19744ffe6..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,11 +73,21 @@ 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.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), + vol_btn(0.5), adf_btn(true), bfo_btn(false), 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; @@ -296,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 ); @@ -334,30 +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; } - // cout << "goal = " << goal_needle_deg << "actual = " << needle_deg - // << endl; + // 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, + // 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" ); } @@ -382,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;