// kt-70.cxx -- class to impliment the King KT 70 panel-m transponder // // Written by Curtis Olson, started July 2002. // // Copyright (C) 2002 Curtis L. Olson - curt@flightgear.org // // This program is free software; you can redistribute it and/or // modify it under the terms of the GNU General Public License as // published by the Free Software Foundation; either version 2 of the // License, or (at your option) any later version. // // This program is distributed in the hope that it will be useful, but // WITHOUT ANY WARRANTY; without even the implied warranty of // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU // General Public License for more details. // // You should have received a copy of the GNU General Public License // along with this program; if not, write to the Free Software // Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. // // $Id$ #ifdef HAVE_CONFIG_H # include #endif #include // snprintf #include #include #include #include "kt_70.hxx" // Constructor FGKT_70::FGKT_70() : lon_node(fgGetNode("/position/longitude-deg", true)), lat_node(fgGetNode("/position/latitude-deg", true)), alt_node(fgGetNode("/position/altitude-ft", true)), r_flash_time(0.0), ident_mode(false), ident_btn(false), last_ident_btn(false), digit1(1), digit2(2), digit3(0), digit4(0), func_knob(4), id_code(1200), flight_level(0), fl_ann(0), alt_ann(0), gnd_ann(0), on_ann(0), sby_ann(0), reply_ann(0) { } // Destructor FGKT_70::~FGKT_70() { } void FGKT_70::init () { update(0); // FIXME: use dt } void FGKT_70::bind () { // internal values // modes // input and buttons fgTie("/radios/kt-70/inputs/ident-btn", this, &FGKT_70::get_ident_btn, &FGKT_70::set_ident_btn); fgSetArchivable("/radios/kt-70/inputs/rotation-deg"); fgTie("/radios/kt-70/inputs/digit1", this, &FGKT_70::get_digit1, &FGKT_70::set_digit1); fgSetArchivable("/radios/kt-70/inputs/digit1"); fgTie("/radios/kt-70/inputs/digit2", this, &FGKT_70::get_digit2, &FGKT_70::set_digit2); fgSetArchivable("/radios/kt-70/inputs/digit2"); fgTie("/radios/kt-70/inputs/digit3", this, &FGKT_70::get_digit3, &FGKT_70::set_digit3); fgSetArchivable("/radios/kt-70/inputs/digit3"); fgTie("/radios/kt-70/inputs/digit4", this, &FGKT_70::get_digit4, &FGKT_70::set_digit4); fgSetArchivable("/radios/kt-70/inputs/digit4"); fgTie("/radios/kt-70/inputs/func-knob", this, &FGKT_70::get_func_knob, &FGKT_70::set_func_knob); fgSetArchivable("/radios/kt-70/inputs/func-knob"); // outputs fgTie("/radios/kt-70/outputs/id-code", this, &FGKT_70::get_id_code, &FGKT_70::set_id_code); fgSetArchivable("/radios/kt-70/outputs/id-code"); fgTie("/radios/kt-70/outputs/flight-level", this, &FGKT_70::get_flight_level); // annunciators fgTie("/radios/kt-70/annunciators/fl", this, &FGKT_70::get_fl_ann ); fgTie("/radios/kt-70/annunciators/alt", this, &FGKT_70::get_alt_ann ); fgTie("/radios/kt-70/annunciators/gnd", this, &FGKT_70::get_gnd_ann ); fgTie("/radios/kt-70/annunciators/on", this, &FGKT_70::get_on_ann ); fgTie("/radios/kt-70/annunciators/sby", this, &FGKT_70::get_sby_ann ); fgTie("/radios/kt-70/annunciators/reply", this, &FGKT_70::get_reply_ann ); } void FGKT_70::unbind () { // internal values // modes // input and buttons fgUntie("/radios/kt-70/inputs/ident-btn"); fgUntie("/radios/kt-70/inputs/digit1"); fgUntie("/radios/kt-70/inputs/digit2"); fgUntie("/radios/kt-70/inputs/digit3"); fgUntie("/radios/kt-70/inputs/digit4"); fgUntie("/radios/kt-70/inputs/func-knob"); // outputs fgUntie("/radios/kt-70/outputs/id-code"); fgUntie("/radios/kt-70/outputs/flight-level"); // annunciators fgUntie("/radios/kt-70/annunciators/fl"); fgUntie("/radios/kt-70/annunciators/alt"); fgUntie("/radios/kt-70/annunciators/gnd"); fgUntie("/radios/kt-70/annunciators/on"); fgUntie("/radios/kt-70/annunciators/sby"); fgUntie("/radios/kt-70/annunciators/reply"); } // Update the various nav values based on position and valid tuned in navs void FGKT_70::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; // Point3D aircraft = sgGeodToCart( Point3D( acft_lon, acft_lat, // acft_elev ) ); // sanity checks if ( digit1 < 0 ) { digit1 = 0; } if ( digit1 > 7 ) { digit1 = 7; } if ( digit2 < 0 ) { digit2 = 0; } if ( digit2 > 7 ) { digit2 = 7; } if ( digit3 < 0 ) { digit3 = 0; } if ( digit3 > 7 ) { digit3 = 7; } if ( digit4 < 0 ) { digit4 = 0; } if ( digit4 > 7 ) { digit4 = 7; } id_code = digit1 * 1000 + digit2 * 100 + digit3 * 10 + digit4; // flight level computation // FIXME!!!! This needs to be computed relative to 29.92 inHg, but // for the moment, until I figure out how to do that, I'll just // use true altitude. flight_level = (int)( (alt_node->getDoubleValue() + 50.0) / 100.0); // ident button if ( ident_btn && !last_ident_btn ) { // ident button depressed r_flash_time = 0.0; ident_mode = true; } r_flash_time += dt; if ( r_flash_time > 18.0 ) { ident_mode = false; } // start with all annunciators off (reply ann is handled // separately) and then turn on the ones we want fl_ann = false; alt_ann = false; gnd_ann = false; on_ann = false; sby_ann = false; if ( ident_mode ) { reply_ann = true; } else { reply_ann = false; } if ( func_knob == 0 ) { // leave everything off } else if ( func_knob == 1 ) { sby_ann = true; } else if ( func_knob == 2 ) { fl_ann = true; alt_ann = true; gnd_ann = true; on_ann = true; sby_ann = true; reply_ann = true; } else if ( func_knob == 3 ) { fl_ann = true; gnd_ann = true; } else if ( func_knob == 4 ) { on_ann = true; } else if ( func_knob == 5 ) { fl_ann = true; alt_ann = true; } }