X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FCockpit%2Fkr_87.cxx;h=2c65a3823e84f1fe8863e1150feea021dc4b533d;hb=430f030cbf8ca11a89a476f411464890bd08f951;hp=6d9a8a22f15d6ded3f803ecbe260875bad39779b;hpb=a6c192911d962f1226db1574b16e373271bbe51a;p=flightgear.git diff --git a/src/Cockpit/kr_87.cxx b/src/Cockpit/kr_87.cxx index 6d9a8a22f..2c65a3823 100644 --- a/src/Cockpit/kr_87.cxx +++ b/src/Cockpit/kr_87.cxx @@ -39,8 +39,8 @@ #include SG_USING_STD(string); -static int adf_play_count = 0; -static time_t adf_last_time = 0; +static int play_count = 0; +static time_t last_time = 0; /** @@ -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; } @@ -74,10 +74,34 @@ FGKR_87::FGKR_87() : lat_node(fgGetNode("/position/latitude-deg", true)), alt_node(fgGetNode("/position/altitude-ft", true)), need_update(true), - adf_valid(false), - adf_freq(0.0), - adf_alt_freq(0.0), - adf_vol_btn(0.0) + valid(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), + flt_et_btn(false), + last_flt_et_btn(false), + set_rst_btn(false), + last_set_rst_btn(false), + 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) { SGPath path( globals->get_fg_root() ); SGPath term = path; @@ -94,130 +118,362 @@ FGKR_87::FGKR_87() : // Destructor -FGKR_87::~FGKR_87() -{ +FGKR_87::~FGKR_87() { delete term_tbl; delete low_tbl; delete high_tbl; } -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_adf_freq, &FGKR_87::set_adf_freq); - fgSetArchivable("/radios/adf/frequencies/selected-khz"); - fgTie("/radios/adf/frequencies/standby-khz", this, - &FGKR_87::get_adf_alt_freq, &FGKR_87::set_adf_alt_freq); - fgSetArchivable("/radios/adf/frequencies/standby-khz"); - fgTie("/radios/adf/rotation-deg", this, - &FGKR_87::get_adf_rotation, &FGKR_87::set_adf_rotation); - fgSetArchivable("/radios/adf/rotation-deg"); - fgTie("/radios/adf/volume", this, - &FGKR_87::get_adf_vol_btn, - &FGKR_87::set_adf_vol_btn); - fgSetArchivable("/radios/adf/volume"); - fgTie("/radios/adf/ident", this, - &FGKR_87::get_adf_ident_btn, - &FGKR_87::set_adf_ident_btn); - fgSetArchivable("/radios/adf/ident"); - - // calculated values - fgTie("/radios/adf/inrange", this, &FGKR_87::get_adf_inrange); - fgTie("/radios/adf/heading", this, &FGKR_87::get_adf_heading); + +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/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/kr-87/inputs/bfo-btn", this, + &FGKR_87::get_bfo_btn, + &FGKR_87::set_bfo_btn); + fgTie("/radios/kr-87/inputs/frq-btn", this, + &FGKR_87::get_frq_btn, + &FGKR_87::set_frq_btn); + 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/inputs/set-rst-btn", this, + &FGKR_87::get_set_rst_btn, + &FGKR_87::set_set_rst_btn); + 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/on"); - fgUntie("/radios/adf/ident"); - fgUntie("/radios/adf/inrange"); - fgUntie("/radios/adf/heading"); + +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; //////////////////////////////////////////////////////////////////////// - // ADF + // Radio //////////////////////////////////////////////////////////////////////// - if ( adf_valid ) { - // staightline distance - station = Point3D( adf_x, adf_y, adf_z ); - adf_dist = aircraft.distance3D( station ); - - // wgs84 heading - geo_inverse_wgs_84( elev, lat * SGD_RADIANS_TO_DEGREES, - lon * SGD_RADIANS_TO_DEGREES, - adf_lat, adf_lon, - &az1, &az2, &s ); - adf_heading = az1; - // cout << " heading = " << adf_heading - // << " dist = " << adf_dist << endl; - - adf_effective_range = kludgeRange(adf_elev, elev, adf_range); - if ( adf_dist < adf_effective_range * SG_NM_TO_METER ) { - adf_inrange = true; - } else if ( adf_dist < 2 * adf_effective_range * SG_NM_TO_METER ) { - adf_inrange = sg_random() < - ( 2 * adf_effective_range * SG_NM_TO_METER - adf_dist ) / - (adf_effective_range * SG_NM_TO_METER); - } else { - adf_inrange = false; - } + if ( power_btn ) { + // buttons + if ( adf_btn == 0 ) { + ant_mode = 1; + } else { + ant_mode = 0; + } + + if ( frq_btn && frq_btn != last_frq_btn && stby_mode == 0 ) { + double tmp = freq; + freq = stby_freq; + stby_freq = tmp; + } else if ( frq_btn ) { + stby_mode = 0; + count_mode = 0; + } + last_frq_btn = frq_btn; + + if ( flt_et_btn && flt_et_btn != last_flt_et_btn ) { + if ( stby_mode == 0 ) { + timer_mode = 0; + } else { + timer_mode = !timer_mode; + } + stby_mode = 1; + } + last_flt_et_btn = flt_et_btn; + + if ( set_rst_btn == 1 && set_rst_btn != last_set_rst_btn ) { + // button depressed + tmp_timer = 0.0; + } + if ( set_rst_btn == 1 && set_rst_btn == last_set_rst_btn ) { + // button depressed and was last iteration too + tmp_timer += dt; + cout << "tmp_timer = " << tmp_timer << endl; + 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 { + count_mode = 0; + elapsed_timer = 0.0; + } + } + last_set_rst_btn = set_rst_btn; + + // timers + flight_timer += dt; + + if ( set_rst_btn == 0 ) { + // only count if set/rst button not depressed + if ( count_mode == 0 ) { + elapsed_timer += dt; + } else if ( count_mode == 1 ) { + elapsed_timer -= dt; + if ( elapsed_timer < 1.0 ) { + count_mode = 0; + elapsed_timer = 0.0; + } + } + } + + // 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( 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(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 ) { + inrange = sg_random() < + ( 2 * effective_range * SG_NM_TO_METER - dist ) / + (effective_range * SG_NM_TO_METER); + } else { + inrange = false; + } + + if ( inrange ) { + goal_needle_deg = heading + - fgGetDouble("/orientation/heading-deg"); + } + } else { + inrange = false; + } + + if ( ant_mode ) { + 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 { - adf_inrange = false; + 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 ( adf_valid && adf_inrange ) { - // play station ident via audio system if on + ident, + if ( valid && inrange ) { + // play station ident via audio system if on + ident_btn, // otherwise turn it off - if ( adf_vol_btn > 0.1 && adf_ident_btn ) { + if ( vol_btn >= 0.01 && ident_btn ) { FGSimpleSound *sound; sound = globals->get_soundmgr()->find( "adf-ident" ); if ( sound != NULL ) { - sound->set_volume( adf_vol_btn ); + sound->set_volume( vol_btn ); } else { SG_LOG( SG_COCKPIT, SG_ALERT, "Can't find adf-ident sound" ); } - if ( adf_last_time < + if ( last_time < globals->get_time_params()->get_cur_time() - 30 ) { - adf_last_time = globals->get_time_params()->get_cur_time(); - adf_play_count = 0; + last_time = globals->get_time_params()->get_cur_time(); + play_count = 0; } - if ( adf_play_count < 4 ) { + if ( play_count < 4 ) { // play ADF ident if ( !globals->get_soundmgr()->is_playing("adf-ident") ) { globals->get_soundmgr()->play_once( "adf-ident" ); - ++adf_play_count; + ++play_count; } } } else { @@ -229,57 +485,56 @@ FGKR_87::update(double dt) // 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_adf_ident = ""; + static string last_ident = ""; //////////////////////////////////////////////////////////////////////// // ADF. //////////////////////////////////////////////////////////////////////// - if ( current_navlist->query( lon, lat, elev, adf_freq, &nav ) ) { - char freq[128]; - snprintf( freq, 10, "%.0f", adf_freq ); - adf_ident = freq; - adf_ident += nav.get_ident(); - // cout << "adf ident = " << adf_ident << endl; - adf_valid = true; - if ( last_adf_ident != adf_ident ) { - last_adf_ident = adf_ident; - - adf_trans_ident = nav.get_trans_ident(); - adf_lon = nav.get_lon(); - adf_lat = nav.get_lat(); - adf_elev = nav.get_elev(); - adf_range = nav.get_range(); - adf_effective_range = kludgeRange(adf_elev, elev, adf_range); - adf_x = nav.get_x(); - adf_y = nav.get_y(); - adf_z = nav.get_z(); + if ( current_navlist->query( acft_lon, acft_lat, acft_elev, freq, &nav ) ) { + char sfreq[128]; + snprintf( sfreq, 10, "%.0f", freq ); + ident = sfreq; + 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(); + effective_range = kludgeRange(stn_elev, acft_elev, range); + 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" ); } FGSimpleSound *sound; - sound = morse.make_ident( adf_trans_ident, LO_FREQUENCY ); + sound = morse.make_ident( trans_ident, LO_FREQUENCY ); sound->set_volume( 0.3 ); globals->get_soundmgr()->add( sound, "adf-ident" ); int offset = (int)(sg_random() * 30.0); - adf_play_count = offset / 4; - adf_last_time = globals->get_time_params()->get_cur_time() - + play_count = offset / 4; + last_time = globals->get_time_params()->get_cur_time() - offset; // cout << "offset = " << offset << " play_count = " - // << adf_play_count << " adf_last_time = " - // << adf_last_time << " current time = " + // << play_count << " last_time = " + // << last_time << " current time = " // << globals->get_time_params()->get_cur_time() << endl; #endif @@ -287,13 +542,26 @@ void FGKR_87::search() // cout << " id = " << nav.get_ident() << endl; } } else { - adf_valid = false; - adf_ident = ""; - adf_trans_ident = ""; + valid = false; + ident = ""; + trans_ident = ""; #ifdef ENABLE_AUDIO_SUPPORT globals->get_soundmgr()->remove( "adf-ident" ); #endif - last_adf_ident = ""; + last_ident = ""; // cout << "not picking up adf. :-(" << endl; } } + + +double FGKR_87::get_stby_freq() const { + if ( stby_mode == 0 ) { + return stby_freq; + } else { + if ( timer_mode == 0 ) { + return flight_timer; + } else { + return elapsed_timer; + } + } +}