- ATC-Inputs.cxx: Fix some portability problems for non-linux operating
systems. Fix a couple bugs/oversights. - atc610x.cxx: Much code has moved into the configurable input mapper (ATC-Inputs.cxx) and the remaining input massaging code has moved into the atcsim.nas module.
This commit is contained in:
curt
parent
7f9566111d
commit
a1265ddc1d
3 changed files with 45 additions and 505 deletions
|
|
@ -27,6 +27,12 @@
|
||||||
|
|
||||||
#include <simgear/compiler.h>
|
#include <simgear/compiler.h>
|
||||||
|
|
||||||
|
#if defined( unix ) || defined( __CYGWIN__ )
|
||||||
|
# include <sys/types.h>
|
||||||
|
# include <sys/stat.h>
|
||||||
|
# include <fcntl.h>
|
||||||
|
#endif
|
||||||
|
|
||||||
#include STL_STRING
|
#include STL_STRING
|
||||||
|
|
||||||
#include <simgear/debug/logstream.hxx>
|
#include <simgear/debug/logstream.hxx>
|
||||||
|
|
@ -131,6 +137,8 @@ bool FGATCInput::open() {
|
||||||
snprintf( radios_file, 256, "/proc/atc610x/board%d/radios", board );
|
snprintf( radios_file, 256, "/proc/atc610x/board%d/radios", board );
|
||||||
snprintf( switches_file, 256, "/proc/atc610x/board%d/switches", board );
|
snprintf( switches_file, 256, "/proc/atc610x/board%d/switches", board );
|
||||||
|
|
||||||
|
#if defined( unix ) || defined( __CYGWIN__ )
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
||||||
// Open the /proc files
|
// Open the /proc files
|
||||||
/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
||||||
|
|
@ -171,6 +179,8 @@ bool FGATCInput::open() {
|
||||||
exit( -1 );
|
exit( -1 );
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
||||||
// Finished initing hardware
|
// Finished initing hardware
|
||||||
/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
||||||
|
|
@ -761,12 +771,12 @@ bool FGATCInput::do_radio_switches() {
|
||||||
string type = "";
|
string type = "";
|
||||||
vector <SGPropertyNode *> output_nodes; output_nodes.clear();
|
vector <SGPropertyNode *> output_nodes; output_nodes.clear();
|
||||||
int byte_num = -1;
|
int byte_num = -1;
|
||||||
int right_shift = -1;
|
int right_shift = 0;
|
||||||
int mask = 0xff;
|
int mask = 0xff;
|
||||||
int factor = 1;
|
int factor = 1;
|
||||||
int offset = 0;
|
int offset = 0;
|
||||||
|
bool invert = false;
|
||||||
int scaled_value = 0;
|
int scaled_value = 0;
|
||||||
|
|
||||||
// get common options
|
// get common options
|
||||||
|
|
||||||
SGPropertyNode *prop;
|
SGPropertyNode *prop;
|
||||||
|
|
@ -805,12 +815,19 @@ bool FGATCInput::do_radio_switches() {
|
||||||
if ( prop != NULL ) {
|
if ( prop != NULL ) {
|
||||||
offset = prop->getIntValue();
|
offset = prop->getIntValue();
|
||||||
}
|
}
|
||||||
|
prop = child->getChild( "invert" );
|
||||||
|
if ( prop != NULL ) {
|
||||||
|
invert = prop->getBoolValue();
|
||||||
|
}
|
||||||
|
|
||||||
// Fetch the raw value
|
// Fetch the raw value
|
||||||
int raw_value
|
int raw_value
|
||||||
= (radio_switch_data[byte_num] >> right_shift) & mask;
|
= (radio_switch_data[byte_num] >> right_shift) & mask;
|
||||||
|
|
||||||
// Cook the value
|
// Cook the value
|
||||||
|
if ( invert ) {
|
||||||
|
raw_value = !raw_value;
|
||||||
|
}
|
||||||
scaled_value = raw_value * factor + offset;
|
scaled_value = raw_value * factor + offset;
|
||||||
|
|
||||||
// update the property tree values
|
// update the property tree values
|
||||||
|
|
@ -843,6 +860,9 @@ bool FGATCInput::process() {
|
||||||
|
|
||||||
|
|
||||||
bool FGATCInput::close() {
|
bool FGATCInput::close() {
|
||||||
|
|
||||||
|
#if defined( unix ) || defined( __CYGWIN__ )
|
||||||
|
|
||||||
int result;
|
int result;
|
||||||
|
|
||||||
result = ::close( lock_fd );
|
result = ::close( lock_fd );
|
||||||
|
|
@ -881,5 +901,7 @@ bool FGATCInput::close() {
|
||||||
exit( -1 );
|
exit( -1 );
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
|
|
|
||||||
|
|
@ -46,6 +46,7 @@
|
||||||
#include <simgear/misc/sg_path.hxx>
|
#include <simgear/misc/sg_path.hxx>
|
||||||
#include <simgear/props/props.hxx>
|
#include <simgear/props/props.hxx>
|
||||||
|
|
||||||
|
#include <Scripting/NasalSys.hxx>
|
||||||
#include <Main/fg_props.hxx>
|
#include <Main/fg_props.hxx>
|
||||||
#include <Main/globals.hxx>
|
#include <Main/globals.hxx>
|
||||||
|
|
||||||
|
|
@ -103,18 +104,6 @@ static int ATC610xSetRadios( int fd,
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
// Read status of last radios written to
|
|
||||||
static void ATC610xReadRadios( int fd, unsigned char *switch_data ) {
|
|
||||||
// rewind
|
|
||||||
lseek( fd, 0, SEEK_SET );
|
|
||||||
|
|
||||||
int result = read( fd, switch_data, ATC_RADIO_SWITCH_BYTES );
|
|
||||||
if ( result != ATC_RADIO_SWITCH_BYTES ) {
|
|
||||||
SG_LOG( SG_IO, SG_ALERT, "Read failed" );
|
|
||||||
exit( -1 );
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// Write a stepper command
|
// Write a stepper command
|
||||||
static int ATC610xSetStepper( int fd, unsigned char channel,
|
static int ATC610xSetStepper( int fd, unsigned char channel,
|
||||||
unsigned char value )
|
unsigned char value )
|
||||||
|
|
@ -487,6 +476,9 @@ bool FGATC610x::open() {
|
||||||
true );
|
true );
|
||||||
dme_serviceable = fgGetNode( "/instrumentation/dme/serviceable", true );
|
dme_serviceable = fgGetNode( "/instrumentation/dme/serviceable", true );
|
||||||
|
|
||||||
|
dme_selector
|
||||||
|
= fgGetNode( "/input/atc-board/radio-switches/raw/dme-switch-position");
|
||||||
|
|
||||||
// default to having everything serviceable
|
// default to having everything serviceable
|
||||||
comm1_serviceable->setBoolValue( true );
|
comm1_serviceable->setBoolValue( true );
|
||||||
comm2_serviceable->setBoolValue( true );
|
comm2_serviceable->setBoolValue( true );
|
||||||
|
|
@ -531,495 +523,6 @@ bool FGATC610x::do_lights() {
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////
|
|
||||||
// Read radio switches
|
|
||||||
/////////////////////////////////////////////////////////////////////
|
|
||||||
|
|
||||||
bool FGATC610x::do_radio_switches() {
|
|
||||||
double freq, coarse_freq, fine_freq, value;
|
|
||||||
int diff;
|
|
||||||
|
|
||||||
ATC610xReadRadios( radios_fd, radio_switch_data );
|
|
||||||
|
|
||||||
// DME Switch
|
|
||||||
dme_switch = (radio_switch_data[7] >> 4) & 0x03;
|
|
||||||
if ( dme_switch == 0 ) {
|
|
||||||
// off
|
|
||||||
fgSetInt( "/instrumentation/dme/switch-position", 0 );
|
|
||||||
} else if ( dme_switch == 2 ) {
|
|
||||||
// nav1
|
|
||||||
fgSetInt( "/instrumentation/dme/switch-position", 1 );
|
|
||||||
fgSetString( "/instrumentation/dme/frequencies/source",
|
|
||||||
"/radios/nav[0]/frequencies/selected-mhz" );
|
|
||||||
freq = fgGetFloat( "/radios/nav[0]/frequencies/selected-mhz", true );
|
|
||||||
fgSetFloat( "/instrumentation/dme/frequencies/selected-mhz", freq );
|
|
||||||
} else if ( dme_switch == 1 ) {
|
|
||||||
// nav2
|
|
||||||
fgSetInt( "/instrumentation/dme/switch-position", 3 );
|
|
||||||
fgSetString( "/instrumentation/dme/frequencies/source",
|
|
||||||
"/radios/nav[1]/frequencies/selected-mhz" );
|
|
||||||
freq = fgGetFloat( "/radios/nav[1]/frequencies/selected-mhz", true );
|
|
||||||
fgSetFloat( "/instrumentation/dme/frequencies/selected-mhz", freq );
|
|
||||||
}
|
|
||||||
|
|
||||||
// NavCom1 Power
|
|
||||||
fgSetBool( "/radios/comm[0]/inputs/power-btn",
|
|
||||||
radio_switch_data[7] & 0x01 );
|
|
||||||
|
|
||||||
if ( navcom1_has_power() && comm1_serviceable->getBoolValue() ) {
|
|
||||||
// Com1 Swap
|
|
||||||
int com1_swap = ((radio_switch_data[7] >> 1) & 0x01);
|
|
||||||
static int last_com1_swap;
|
|
||||||
if ( com1_swap && (last_com1_swap != com1_swap) ) {
|
|
||||||
float tmp = com1_freq->getFloatValue();
|
|
||||||
fgSetFloat( "/radios/comm[0]/frequencies/selected-mhz",
|
|
||||||
com1_stby_freq->getFloatValue() );
|
|
||||||
fgSetFloat( "/radios/comm[0]/frequencies/standby-mhz", tmp );
|
|
||||||
}
|
|
||||||
last_com1_swap = com1_swap;
|
|
||||||
}
|
|
||||||
|
|
||||||
// NavCom2 Power
|
|
||||||
fgSetBool( "/radios/comm[1]/inputs/power-btn",
|
|
||||||
radio_switch_data[15] & 0x01 );
|
|
||||||
|
|
||||||
if ( navcom2_has_power() && comm2_serviceable->getBoolValue() ) {
|
|
||||||
// Com2 Swap
|
|
||||||
int com2_swap = ((radio_switch_data[15] >> 1) & 0x01);
|
|
||||||
static int last_com2_swap;
|
|
||||||
if ( com2_swap && (last_com2_swap != com2_swap) ) {
|
|
||||||
float tmp = com2_freq->getFloatValue();
|
|
||||||
fgSetFloat( "/radios/comm[1]/frequencies/selected-mhz",
|
|
||||||
com2_stby_freq->getFloatValue() );
|
|
||||||
fgSetFloat( "/radios/comm[1]/frequencies/standby-mhz", tmp );
|
|
||||||
}
|
|
||||||
last_com2_swap = com2_swap;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( navcom1_has_power() && nav1_serviceable->getBoolValue() ) {
|
|
||||||
// Nav1 Swap
|
|
||||||
int nav1_swap = radio_switch_data[11] & 0x01;
|
|
||||||
static int last_nav1_swap;
|
|
||||||
if ( nav1_swap && (last_nav1_swap != nav1_swap) ) {
|
|
||||||
float tmp = nav1_freq->getFloatValue();
|
|
||||||
fgSetFloat( "/radios/nav[0]/frequencies/selected-mhz",
|
|
||||||
nav1_stby_freq->getFloatValue() );
|
|
||||||
fgSetFloat( "/radios/nav[0]/frequencies/standby-mhz", tmp );
|
|
||||||
}
|
|
||||||
last_nav1_swap = nav1_swap;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( navcom2_has_power() && nav2_serviceable->getBoolValue() ) {
|
|
||||||
// Nav2 Swap
|
|
||||||
int nav2_swap = (radio_switch_data[19] & 0x01);
|
|
||||||
static int last_nav2_swap;
|
|
||||||
if ( nav2_swap && (last_nav2_swap != nav2_swap) ) {
|
|
||||||
float tmp = nav2_freq->getFloatValue();
|
|
||||||
fgSetFloat( "/radios/nav[1]/frequencies/selected-mhz",
|
|
||||||
nav2_stby_freq->getFloatValue() );
|
|
||||||
fgSetFloat( "/radios/nav[1]/frequencies/standby-mhz", tmp );
|
|
||||||
}
|
|
||||||
last_nav2_swap = nav2_swap;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( navcom1_has_power() && comm1_serviceable->getBoolValue() ) {
|
|
||||||
// Com1 Tuner
|
|
||||||
int com1_tuner_fine = ((radio_switch_data[5] >> 4) & 0x0f) - 1;
|
|
||||||
int com1_tuner_coarse = (radio_switch_data[5] & 0x0f) - 1;
|
|
||||||
static int last_com1_tuner_fine = com1_tuner_fine;
|
|
||||||
static int last_com1_tuner_coarse = com1_tuner_coarse;
|
|
||||||
|
|
||||||
freq = com1_stby_freq->getFloatValue();
|
|
||||||
coarse_freq = (int)freq;
|
|
||||||
fine_freq = (int)((freq - coarse_freq) * 40 + 0.5);
|
|
||||||
|
|
||||||
if ( com1_tuner_fine != last_com1_tuner_fine ) {
|
|
||||||
diff = com1_tuner_fine - last_com1_tuner_fine;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( com1_tuner_fine < last_com1_tuner_fine ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_com1_tuner_fine + com1_tuner_fine;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = com1_tuner_fine - 12 - last_com1_tuner_fine;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
fine_freq += diff;
|
|
||||||
}
|
|
||||||
while ( fine_freq >= 40.0 ) { fine_freq -= 40.0; }
|
|
||||||
while ( fine_freq < 0.0 ) { fine_freq += 40.0; }
|
|
||||||
|
|
||||||
if ( com1_tuner_coarse != last_com1_tuner_coarse ) {
|
|
||||||
diff = com1_tuner_coarse - last_com1_tuner_coarse;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( com1_tuner_coarse < last_com1_tuner_coarse ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_com1_tuner_coarse + com1_tuner_coarse;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = com1_tuner_coarse - 12 - last_com1_tuner_coarse;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
coarse_freq += diff;
|
|
||||||
}
|
|
||||||
if ( coarse_freq < 118.0 ) { coarse_freq += 19.0; }
|
|
||||||
if ( coarse_freq > 136.0 ) { coarse_freq -= 19.0; }
|
|
||||||
|
|
||||||
last_com1_tuner_fine = com1_tuner_fine;
|
|
||||||
last_com1_tuner_coarse = com1_tuner_coarse;
|
|
||||||
|
|
||||||
fgSetFloat( "/radios/comm[0]/frequencies/standby-mhz",
|
|
||||||
coarse_freq + fine_freq / 40.0 );
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( navcom2_has_power() && comm2_serviceable->getBoolValue() ) {
|
|
||||||
// Com2 Tuner
|
|
||||||
int com2_tuner_fine = ((radio_switch_data[13] >> 4) & 0x0f) - 1;
|
|
||||||
int com2_tuner_coarse = (radio_switch_data[13] & 0x0f) - 1;
|
|
||||||
static int last_com2_tuner_fine = com2_tuner_fine;
|
|
||||||
static int last_com2_tuner_coarse = com2_tuner_coarse;
|
|
||||||
|
|
||||||
freq = com2_stby_freq->getFloatValue();
|
|
||||||
coarse_freq = (int)freq;
|
|
||||||
fine_freq = (int)((freq - coarse_freq) * 40 + 0.5);
|
|
||||||
|
|
||||||
if ( com2_tuner_fine != last_com2_tuner_fine ) {
|
|
||||||
diff = com2_tuner_fine - last_com2_tuner_fine;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( com2_tuner_fine < last_com2_tuner_fine ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_com2_tuner_fine + com2_tuner_fine;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = com2_tuner_fine - 12 - last_com2_tuner_fine;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
fine_freq += diff;
|
|
||||||
}
|
|
||||||
while ( fine_freq >= 40.0 ) { fine_freq -= 40.0; }
|
|
||||||
while ( fine_freq < 0.0 ) { fine_freq += 40.0; }
|
|
||||||
|
|
||||||
if ( com2_tuner_coarse != last_com2_tuner_coarse ) {
|
|
||||||
diff = com2_tuner_coarse - last_com2_tuner_coarse;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( com2_tuner_coarse < last_com2_tuner_coarse ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_com2_tuner_coarse + com2_tuner_coarse;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = com2_tuner_coarse - 12 - last_com2_tuner_coarse;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
coarse_freq += diff;
|
|
||||||
}
|
|
||||||
if ( coarse_freq < 118.0 ) { coarse_freq += 19.0; }
|
|
||||||
if ( coarse_freq > 136.0 ) { coarse_freq -= 19.0; }
|
|
||||||
|
|
||||||
last_com2_tuner_fine = com2_tuner_fine;
|
|
||||||
last_com2_tuner_coarse = com2_tuner_coarse;
|
|
||||||
|
|
||||||
fgSetFloat( "/radios/comm[1]/frequencies/standby-mhz",
|
|
||||||
coarse_freq + fine_freq / 40.0 );
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( navcom1_has_power() && nav1_serviceable->getBoolValue() ) {
|
|
||||||
// Nav1 Tuner
|
|
||||||
int nav1_tuner_fine = ((radio_switch_data[9] >> 4) & 0x0f) - 1;
|
|
||||||
int nav1_tuner_coarse = (radio_switch_data[9] & 0x0f) - 1;
|
|
||||||
static int last_nav1_tuner_fine = nav1_tuner_fine;
|
|
||||||
static int last_nav1_tuner_coarse = nav1_tuner_coarse;
|
|
||||||
|
|
||||||
freq = nav1_stby_freq->getFloatValue();
|
|
||||||
coarse_freq = (int)freq;
|
|
||||||
fine_freq = (int)((freq - coarse_freq) * 20 + 0.5);
|
|
||||||
|
|
||||||
if ( nav1_tuner_fine != last_nav1_tuner_fine ) {
|
|
||||||
diff = nav1_tuner_fine - last_nav1_tuner_fine;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( nav1_tuner_fine < last_nav1_tuner_fine ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_nav1_tuner_fine + nav1_tuner_fine;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = nav1_tuner_fine - 12 - last_nav1_tuner_fine;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
fine_freq += diff;
|
|
||||||
}
|
|
||||||
while ( fine_freq >= 20.0 ) { fine_freq -= 20.0; }
|
|
||||||
while ( fine_freq < 0.0 ) { fine_freq += 20.0; }
|
|
||||||
|
|
||||||
if ( nav1_tuner_coarse != last_nav1_tuner_coarse ) {
|
|
||||||
diff = nav1_tuner_coarse - last_nav1_tuner_coarse;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( nav1_tuner_coarse < last_nav1_tuner_coarse ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_nav1_tuner_coarse + nav1_tuner_coarse;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = nav1_tuner_coarse - 12 - last_nav1_tuner_coarse;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
coarse_freq += diff;
|
|
||||||
}
|
|
||||||
if ( coarse_freq < 108.0 ) { coarse_freq += 10.0; }
|
|
||||||
if ( coarse_freq > 117.0 ) { coarse_freq -= 10.0; }
|
|
||||||
|
|
||||||
last_nav1_tuner_fine = nav1_tuner_fine;
|
|
||||||
last_nav1_tuner_coarse = nav1_tuner_coarse;
|
|
||||||
|
|
||||||
fgSetFloat( "/radios/nav[0]/frequencies/standby-mhz",
|
|
||||||
coarse_freq + fine_freq / 20.0 );
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( navcom2_has_power() && nav2_serviceable->getBoolValue() ) {
|
|
||||||
// Nav2 Tuner
|
|
||||||
int nav2_tuner_fine = ((radio_switch_data[17] >> 4) & 0x0f) - 1;
|
|
||||||
int nav2_tuner_coarse = (radio_switch_data[17] & 0x0f) - 1;
|
|
||||||
static int last_nav2_tuner_fine = nav2_tuner_fine;
|
|
||||||
static int last_nav2_tuner_coarse = nav2_tuner_coarse;
|
|
||||||
|
|
||||||
freq = nav2_stby_freq->getFloatValue();
|
|
||||||
coarse_freq = (int)freq;
|
|
||||||
fine_freq = (int)((freq - coarse_freq) * 20 + 0.5);
|
|
||||||
|
|
||||||
if ( nav2_tuner_fine != last_nav2_tuner_fine ) {
|
|
||||||
diff = nav2_tuner_fine - last_nav2_tuner_fine;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( nav2_tuner_fine < last_nav2_tuner_fine ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_nav2_tuner_fine + nav2_tuner_fine;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = nav2_tuner_fine - 12 - last_nav2_tuner_fine;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
fine_freq += diff;
|
|
||||||
}
|
|
||||||
while ( fine_freq >= 20.0 ) { fine_freq -= 20.0; }
|
|
||||||
while ( fine_freq < 0.0 ) { fine_freq += 20.0; }
|
|
||||||
|
|
||||||
if ( nav2_tuner_coarse != last_nav2_tuner_coarse ) {
|
|
||||||
diff = nav2_tuner_coarse - last_nav2_tuner_coarse;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( nav2_tuner_coarse < last_nav2_tuner_coarse ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_nav2_tuner_coarse + nav2_tuner_coarse;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = nav2_tuner_coarse - 12 - last_nav2_tuner_coarse;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
coarse_freq += diff;
|
|
||||||
}
|
|
||||||
if ( coarse_freq < 108.0 ) { coarse_freq += 10.0; }
|
|
||||||
if ( coarse_freq > 117.0 ) { coarse_freq -= 10.0; }
|
|
||||||
|
|
||||||
last_nav2_tuner_fine = nav2_tuner_fine;
|
|
||||||
last_nav2_tuner_coarse = nav2_tuner_coarse;
|
|
||||||
|
|
||||||
fgSetFloat( "/radios/nav[1]/frequencies/standby-mhz",
|
|
||||||
coarse_freq + fine_freq / 20.0);
|
|
||||||
}
|
|
||||||
|
|
||||||
// ADF Tuner
|
|
||||||
|
|
||||||
int adf_tuner_fine = ((radio_switch_data[21] >> 4) & 0x0f) - 1;
|
|
||||||
int adf_tuner_coarse = (radio_switch_data[21] & 0x0f) - 1;
|
|
||||||
static int last_adf_tuner_fine = adf_tuner_fine;
|
|
||||||
static int last_adf_tuner_coarse = adf_tuner_coarse;
|
|
||||||
|
|
||||||
if ( adf_has_power() && adf_serviceable->getBoolValue() ) {
|
|
||||||
// cout << "adf_stby_mode = " << adf_stby_mode->getIntValue() << endl;
|
|
||||||
if ( adf_count_mode->getIntValue() == 2 ) {
|
|
||||||
// tune count down timer
|
|
||||||
value = adf_elapsed_timer->getDoubleValue();
|
|
||||||
} else {
|
|
||||||
// tune frequency
|
|
||||||
if ( adf_stby_mode->getIntValue() == 1 ) {
|
|
||||||
value = adf_freq->getFloatValue();
|
|
||||||
} else {
|
|
||||||
value = adf_stby_freq->getFloatValue();
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( adf_tuner_fine != last_adf_tuner_fine ) {
|
|
||||||
diff = adf_tuner_fine - last_adf_tuner_fine;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( adf_tuner_fine < last_adf_tuner_fine ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_adf_tuner_fine + adf_tuner_fine;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = adf_tuner_fine - 12 - last_adf_tuner_fine;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
value += diff;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( adf_tuner_coarse != last_adf_tuner_coarse ) {
|
|
||||||
diff = adf_tuner_coarse - last_adf_tuner_coarse;
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( adf_tuner_coarse < last_adf_tuner_coarse ) {
|
|
||||||
// going up
|
|
||||||
diff = 12 - last_adf_tuner_coarse + adf_tuner_coarse;
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = adf_tuner_coarse - 12 - last_adf_tuner_coarse;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if ( adf_count_mode->getIntValue() == 2 ) {
|
|
||||||
value += 60 * diff;
|
|
||||||
} else {
|
|
||||||
value += 25 * diff;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if ( adf_count_mode->getIntValue() == 2 ) {
|
|
||||||
if ( value < 0 ) { value += 3600; }
|
|
||||||
if ( value > 3599 ) { value -= 3600; }
|
|
||||||
} else {
|
|
||||||
if ( value < 200 ) { value += 1600; }
|
|
||||||
if ( value > 1799 ) { value -= 1600; }
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( adf_count_mode->getIntValue() == 2 ) {
|
|
||||||
fgSetFloat( "/radios/kr-87/outputs/elapsed-timer", value );
|
|
||||||
} else {
|
|
||||||
if ( adf_stby_mode->getIntValue() == 1 ) {
|
|
||||||
fgSetFloat( "/radios/kr-87/outputs/selected-khz", value );
|
|
||||||
} else {
|
|
||||||
fgSetFloat( "/radios/kr-87/outputs/standby-khz", value );
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
last_adf_tuner_fine = adf_tuner_fine;
|
|
||||||
last_adf_tuner_coarse = adf_tuner_coarse;
|
|
||||||
|
|
||||||
|
|
||||||
// ADF buttons
|
|
||||||
#define CURT_HARDWARE
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/adf-btn",
|
|
||||||
(radio_switch_data[23] & 0x01) );
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/bfo-btn",
|
|
||||||
(radio_switch_data[23] >> 1 & 0x01) );
|
|
||||||
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/frq-btn",
|
|
||||||
(radio_switch_data[23] >> 2 & 0x01) );
|
|
||||||
|
|
||||||
#ifdef CURT_HARDWARE
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/flt-et-btn",
|
|
||||||
!(radio_switch_data[23] >> 3 & 0x01) );
|
|
||||||
#else
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/flt-et-btn",
|
|
||||||
(radio_switch_data[23] >> 3 & 0x01) );
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#ifdef CURT_HARDWARE
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/set-rst-btn",
|
|
||||||
!(radio_switch_data[23] >> 4 & 0x01) );
|
|
||||||
#else
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/set-rst-btn",
|
|
||||||
(radio_switch_data[23] >> 4 & 0x01) );
|
|
||||||
#endif
|
|
||||||
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/power-btn",
|
|
||||||
radio_switch_data[23] >> 5 & 0x01 );
|
|
||||||
/* cout << "adf = " << !(radio_switch_data[23] & 0x01)
|
|
||||||
<< " bfo = " << !(radio_switch_data[23] >> 1 & 0x01)
|
|
||||||
<< " frq = " << !(radio_switch_data[23] >> 2 & 0x01)
|
|
||||||
<< " flt/et = " << !(radio_switch_data[23] >> 3 & 0x01)
|
|
||||||
<< " set/rst = " << !(radio_switch_data[23] >> 4 & 0x01)
|
|
||||||
<< endl; */
|
|
||||||
|
|
||||||
// Transponder Tuner
|
|
||||||
int i;
|
|
||||||
int digit_tuner[4];
|
|
||||||
digit_tuner[0] = radio_switch_data[25] & 0x0f;
|
|
||||||
digit_tuner[1] = ( radio_switch_data[25] >> 4 ) & 0x0f;
|
|
||||||
digit_tuner[2] = radio_switch_data[29] & 0x0f;
|
|
||||||
digit_tuner[3] = ( radio_switch_data[29] >> 4 ) & 0x0f;
|
|
||||||
|
|
||||||
static int last_digit_tuner[4];
|
|
||||||
static bool first_time = true;
|
|
||||||
if ( first_time ) {
|
|
||||||
first_time = false;
|
|
||||||
for ( i = 0; i < 4; ++i ) {
|
|
||||||
last_digit_tuner[i] = digit_tuner[i];
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( xpdr_has_power() && xpdr_serviceable->getBoolValue() ) {
|
|
||||||
int id_code = xpdr_id_code->getIntValue();
|
|
||||||
int digit[4];
|
|
||||||
int place = 1000;
|
|
||||||
for ( i = 0; i < 4; ++i ) {
|
|
||||||
digit[i] = id_code / place;
|
|
||||||
id_code -= digit[i] * place;
|
|
||||||
place /= 10;
|
|
||||||
}
|
|
||||||
|
|
||||||
for ( i = 0; i < 4; ++i ) {
|
|
||||||
if ( digit_tuner[i] != last_digit_tuner[i] ) {
|
|
||||||
diff = digit_tuner[i] - last_digit_tuner[i];
|
|
||||||
if ( abs(diff) > 4 ) {
|
|
||||||
// roll over
|
|
||||||
if ( digit_tuner[i] < last_digit_tuner[i] ) {
|
|
||||||
// going up
|
|
||||||
diff = 16 - last_digit_tuner[i] + digit_tuner[i];
|
|
||||||
} else {
|
|
||||||
// going down
|
|
||||||
diff = digit_tuner[i] - 16 - last_digit_tuner[i];
|
|
||||||
}
|
|
||||||
}
|
|
||||||
digit[i] += diff;
|
|
||||||
}
|
|
||||||
while ( digit[i] >= 8 ) { digit[i] -= 8; }
|
|
||||||
while ( digit[i] < 0 ) { digit[i] += 8; }
|
|
||||||
}
|
|
||||||
|
|
||||||
fgSetInt( "/radios/kt-70/inputs/digit1", digit[0] );
|
|
||||||
fgSetInt( "/radios/kt-70/inputs/digit2", digit[1] );
|
|
||||||
fgSetInt( "/radios/kt-70/inputs/digit3", digit[2] );
|
|
||||||
fgSetInt( "/radios/kt-70/inputs/digit4", digit[3] );
|
|
||||||
}
|
|
||||||
for ( i = 0; i < 4; ++i ) {
|
|
||||||
last_digit_tuner[i] = digit_tuner[i];
|
|
||||||
}
|
|
||||||
|
|
||||||
int tmp = 0;
|
|
||||||
for ( i = 0; i < 5; ++i ) {
|
|
||||||
if ( radio_switch_data[27] >> i & 0x01 ) {
|
|
||||||
tmp = i + 1;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
fgSetInt( "/radios/kt-70/inputs/func-knob", tmp );
|
|
||||||
fgSetInt( "/radios/kt-70/inputs/ident-btn",
|
|
||||||
!(radio_switch_data[27] >> 5 & 0x01) );
|
|
||||||
|
|
||||||
// Audio panel switches
|
|
||||||
fgSetInt( "/radios/nav[0]/audio-btn",
|
|
||||||
(radio_switch_data[3] & 0x01) );
|
|
||||||
fgSetInt( "/radios/nav[1]/audio-btn",
|
|
||||||
(radio_switch_data[3] >> 2 & 0x01) );
|
|
||||||
fgSetInt( "/radios/kr-87/inputs/audio-btn",
|
|
||||||
(radio_switch_data[3] >> 4 & 0x01) );
|
|
||||||
fgSetInt( "/radios/marker-beacon/audio-btn",
|
|
||||||
(radio_switch_data[3] >> 6 & 0x01) );
|
|
||||||
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
||||||
// Update the radio display
|
// Update the radio display
|
||||||
/////////////////////////////////////////////////////////////////////
|
/////////////////////////////////////////////////////////////////////
|
||||||
|
|
@ -1410,6 +913,7 @@ bool FGATC610x::process() {
|
||||||
// Lock the hardware, skip if it's not ready yet
|
// Lock the hardware, skip if it's not ready yet
|
||||||
if ( ATC610xLock( lock_fd ) > 0 ) {
|
if ( ATC610xLock( lock_fd ) > 0 ) {
|
||||||
|
|
||||||
|
// process the ATC inputs
|
||||||
if ( input0 != NULL ) {
|
if ( input0 != NULL ) {
|
||||||
input0->process();
|
input0->process();
|
||||||
}
|
}
|
||||||
|
|
@ -1417,8 +921,21 @@ bool FGATC610x::process() {
|
||||||
input1->process();
|
input1->process();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// run our custom nasal script. This is a layer above the raw
|
||||||
|
// hardware inputs. It handles situations where there isn't a
|
||||||
|
// direct 1-1 linear mapping between ATC functionality and FG
|
||||||
|
// functionality, and handles situations where FG expects more
|
||||||
|
// functionality from the interface than the ATC hardware can
|
||||||
|
// directly provide.
|
||||||
|
|
||||||
|
FGNasalSys *n = (FGNasalSys*)globals->get_subsystem("nasal");
|
||||||
|
bool result = n->parseAndRun( "atcsim.do_hardware()" );
|
||||||
|
if ( !result ) {
|
||||||
|
SG_LOG( SG_GENERAL, SG_ALERT,
|
||||||
|
"do_atcflightsim_hardware() failed!" );
|
||||||
|
}
|
||||||
|
|
||||||
do_lights();
|
do_lights();
|
||||||
do_radio_switches();
|
|
||||||
do_radio_display();
|
do_radio_display();
|
||||||
do_steppers();
|
do_steppers();
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -114,12 +114,13 @@ class FGATC610x : public FGProtocol {
|
||||||
SGPropertyNode *nav1vol_min, *nav1vol_max;
|
SGPropertyNode *nav1vol_min, *nav1vol_max;
|
||||||
SGPropertyNode *nav2vol_min, *nav2vol_max;
|
SGPropertyNode *nav2vol_min, *nav2vol_max;
|
||||||
|
|
||||||
|
// raw switch positions
|
||||||
|
SGPropertyNode *dme_selector;
|
||||||
SGPropertyNode *ignore_flight_controls;
|
SGPropertyNode *ignore_flight_controls;
|
||||||
|
|
||||||
int dme_switch;
|
int dme_switch;
|
||||||
|
|
||||||
bool do_lights();
|
bool do_lights();
|
||||||
bool do_radio_switches();
|
|
||||||
bool do_radio_display();
|
bool do_radio_display();
|
||||||
bool do_steppers();
|
bool do_steppers();
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in a new issue