fly/flightgear
1
0
Fork 0
Code Activity
flightgear/src/Instrumentation/tacan.cxx

550 lines
21 KiB
C++
Raw Normal View History

Add missing files.
2005-10-01 11:08:06 +00:00
// tacan.cxx - Tactical Navigation Beacon.
// Written by Vivian Meazaa, started 2005.
//
// This file is in the Public Domain and comes with no warranty.
Recent SimGear changes seem to require more additions of config.h to FG in order to compile on Cygwin
2006-02-22 21:04:47 +00:00
#ifdef HAVE_CONFIG_H
# include <config.h>
#endif
Add missing files.
2005-10-01 11:08:06 +00:00
#include <simgear/compiler.h>
#include <simgear/math/sg_geodesy.hxx>
#include <simgear/math/sg_random.h>
#include <Main/fg_props.hxx>
#include <Navaids/navlist.hxx>
Vivian MEAZZA: bugfix: don't always refer to carrier #0
2005-11-25 18:55:29 +00:00
#include <vector>
Add missing files.
2005-10-01 11:08:06 +00:00
#include "tacan.hxx"
Vivian MEAZZA: bugfix: don't always refer to carrier #0
2005-11-25 18:55:29 +00:00
SG_USING_STD(vector);
Add missing files.
2005-10-01 11:08:06 +00:00
/**
* Adjust the range.
*
* Start by calculating the radar horizon based on the elevation
* difference, then clamp to the maximum, then add a fudge for
* borderline reception.
*/
static double
adjust_range (double transmitter_elevation_ft, double aircraft_altitude_ft,
double max_range_nm)
{
max_range_nm = 150;
double delta_elevation_ft =
fabs(aircraft_altitude_ft - transmitter_elevation_ft);
double range_nm = 1.23 * sqrt(delta_elevation_ft);
if (range_nm > max_range_nm)
range_nm = max_range_nm;
else if (range_nm < 20.0)
range_nm = 20.0;
double rand = sg_random();
SG_LOG( SG_INSTR, SG_DEBUG, " tacan range " << range_nm << " max range " << max_range_nm);
return range_nm + (range_nm * rand * rand);
}
TACAN::TACAN ( SGPropertyNode *node )
: _last_distance_nm(0),
_last_frequency_mhz(-1),
_time_before_search_sec(0),
_carrier_valid(false),
_transmitter_valid(false),
_transmitter_elevation_ft(0),
_transmitter_range_nm(0),
_transmitter_bias(0.0),
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
name("tacan"),
num(0)
{
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
int i;
for ( i = 0; i < node->nChildren(); ++i ) {
SGPropertyNode *child = node->getChild(i);
string cname = child->getName();
string cval = child->getStringValue();
if ( cname == "name" ) {
name = cval;
} else if ( cname == "number" ) {
num = child->getIntValue();
} else {
SG_LOG( SG_INSTR, SG_DEBUG, "Error in TACAN config logic" );
if ( name.length() ) {
SG_LOG( SG_INSTR, SG_DEBUG, "Section = " << name );
}
}
}
}
TACAN::TACAN ()
: _last_distance_nm(0),
_last_frequency_mhz(-1),
_time_before_search_sec(0),
_carrier_valid(false),
_transmitter_valid(false),
_transmitter_elevation_ft(0),
_transmitter_range_nm(0),
_transmitter_bearing_deg(0),
_transmitter_bias(0.0),
_transmitter_name(""),
name("tacan")
{
}
TACAN::~TACAN ()
{
}
void
TACAN::init ()
{
string branch;
branch = "/instrumentation/" + name;
SGPropertyNode *node = fgGetNode(branch.c_str(), num, true );
_longitude_node = fgGetNode("/position/longitude-deg", true);
_latitude_node = fgGetNode("/position/latitude-deg", true);
_altitude_node = fgGetNode("/position/altitude-ft", true);
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
_heading_node = fgGetNode("/orientation/heading-deg", true);
_yaw_node = fgGetNode("/orientation/side-slip-deg", true);
Add missing files.
2005-10-01 11:08:06 +00:00
_serviceable_node = node->getChild("serviceable", 0, true);
_electrical_node = fgGetNode("/systems/electrical/outputs/tacan", true);
SGPropertyNode *fnode = node->getChild("frequencies", 0, true);
_source_node = fnode->getChild("source", 0, true);
_frequency_node = fnode->getChild("selected-mhz", 0, true);
_channel_node = fnode->getChild("selected-channel", 1, true);
_channel_node = fnode->getChild("selected-channel", 2, true);
_channel_node = fnode->getChild("selected-channel", 3, true);
_channel_node = fnode->getChild("selected-channel", 4, true);
_in_range_node = node->getChild("in-range", 0, true);
_distance_node = node->getChild("indicated-distance-nm", 0, true);
_speed_node = node->getChild("indicated-ground-speed-kt", 0, true);
_time_node = node->getChild("indicated-time-min", 0, true);
_name_node = node->getChild("name", 0, true);
_bearing_node = node->getChild("indicated-bearing-true-deg", 0, true);
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
SGPropertyNode *dnode = node->getChild("display", 0, true);
_x_shift_node = dnode->getChild("x-shift", 0, true);
_y_shift_node = dnode->getChild("y-shift", 0, true);
_rotation_node = dnode->getChild("rotation", 0, true);
_channel_node = dnode->getChild("channel", 0, true);
Vivian MEAZZA: bugfix: don't always refer to carrier #0
2005-11-25 18:55:29 +00:00
SGPropertyNode *cnode = fgGetNode("/ai/models/carrier", num, true );
_carrier_name_node = cnode->getChild("name", 0, true);
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
SGPropertyNode *tnode = fgGetNode("/ai/models/aircraft", num, true );
_tanker_callsign_node = tnode->getChild("callsign", 0, true);
Add missing files.
2005-10-01 11:08:06 +00:00
}
void
TACAN::update (double delta_time_sec)
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
{
double az2 = 0;
Add missing files.
2005-10-01 11:08:06 +00:00
double bearing = 0;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
double distance = 0;
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
double carrier_az2 = 0;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
double carrier_bearing = 0;
Add missing files.
2005-10-01 11:08:06 +00:00
double carrier_distance = 0;
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
double tanker_az2 = 0;
double tanker_bearing = 0;
double tanker_distance = 0;
Add missing files.
2005-10-01 11:08:06 +00:00
double frequency_mhz = 0;
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
double mobile_bearing = 0;
double mobile_distance = 0;
double mobile_elevation_ft = 0;
double mobile_range_nm = 0;
double mobile_bias = 0;
string mobile_name = "";
bool mobile_valid = false;
Add missing files.
2005-10-01 11:08:06 +00:00
string _channel, _last_channel, _channel_1, _channel_2,_channel_3, _channel_4;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
// If it's off, don't waste any time.
if (!_serviceable_node->getBoolValue() || !_electrical_node->getBoolValue()) {
_last_distance_nm = 0;
_in_range_node->setBoolValue(false);
_distance_node->setDoubleValue(0);
_speed_node->setDoubleValue(0);
_time_node->setDoubleValue(0);
SG_LOG( SG_INSTR, SG_DEBUG, "skip tacan" );
return;
}
Add missing files.
2005-10-01 11:08:06 +00:00
// Figure out the source
const char * source = _source_node->getStringValue();
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
if (source[0] == '\0') {
string branch;
branch = "/instrumentation/" + name + "/frequencies/selected-channel";
_source_node->setStringValue(branch.c_str());
source = _source_node->getStringValue();
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "source " << source );
Add missing files.
2005-10-01 11:08:06 +00:00
}
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
// Get the channel
Add missing files.
2005-10-01 11:08:06 +00:00
_channel_1 = fgGetString("/instrumentation/tacan/frequencies/selected-channel[1]");
_channel_2 = fgGetString("/instrumentation/tacan/frequencies/selected-channel[2]");
_channel_3 = fgGetString("/instrumentation/tacan/frequencies/selected-channel[3]");
_channel_4 = fgGetString("/instrumentation/tacan/frequencies/selected-channel[4]");
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "channels " << _channel_1 << _channel_2 << _channel_3 << _channel_4);
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
_channel = _channel_1 + _channel_2 + _channel_3 + _channel_4;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
// Get the frequency
Add missing files.
2005-10-01 11:08:06 +00:00
if (_channel != _last_channel) {
_time_before_search_sec = 0;
_last_channel = _channel;
frequency_mhz = searchChannel(_channel);
SG_LOG( SG_INSTR, SG_DEBUG, "frequency " << frequency_mhz );
_frequency_node->setDoubleValue(frequency_mhz);
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
}
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "channel " << _channel );
Add missing files.
2005-10-01 11:08:06 +00:00
// Get the aircraft position
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
double longitude_deg = _longitude_node->getDoubleValue();
double latitude_deg = _latitude_node->getDoubleValue();
double altitude_m = _altitude_node->getDoubleValue() * SG_FEET_TO_METER;
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
double heading = _heading_node->getDoubleValue() ;
double yaw = _yaw_node->getDoubleValue() ;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
double longitude_rad = longitude_deg * SGD_DEGREES_TO_RADIANS;
double latitude_rad = latitude_deg * SGD_DEGREES_TO_RADIANS;
Add missing files.
2005-10-01 11:08:06 +00:00
// On timeout, scan again
_time_before_search_sec -= delta_time_sec;
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
if (_time_before_search_sec < 0 && frequency_mhz >= 0)
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
search(frequency_mhz, longitude_rad, latitude_rad, altitude_m);
Add missing files.
2005-10-01 11:08:06 +00:00
// Calculate the distance to the transmitter
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
//calculate the bearing and range of the carrier from the aircraft
SG_LOG( SG_INSTR, SG_DEBUG, "carrier_lat " << _carrier_lat);
SG_LOG( SG_INSTR, SG_DEBUG, "carrier_lon " << _carrier_lon);
SG_LOG( SG_INSTR, SG_DEBUG, "carrier_name " << _carrier_name);
SG_LOG( SG_INSTR, SG_DEBUG, "carrier_valid " << _carrier_valid);
geo_inverse_wgs_84(altitude_m,
latitude_deg,
longitude_deg,
_carrier_lat,
_carrier_lon,
&carrier_bearing, &carrier_az2, &carrier_distance);
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
//calculate the bearing and range of the tanker from the aircraft
SG_LOG( SG_INSTR, SG_DEBUG, "tanker_lat " << _tanker_lat);
SG_LOG( SG_INSTR, SG_DEBUG, "tanker_lon " << _tanker_lon);
SG_LOG( SG_INSTR, SG_DEBUG, "tanker_name " << _tanker_name);
SG_LOG( SG_INSTR, SG_DEBUG, "tanker_valid " << _tanker_valid);
geo_inverse_wgs_84(altitude_m,
latitude_deg,
longitude_deg,
_tanker_lat,
_tanker_lon,
&tanker_bearing, &tanker_az2, &tanker_distance);
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
//calculate the bearing and range of the station from the aircraft
geo_inverse_wgs_84(altitude_m,
latitude_deg,
longitude_deg,
_transmitter_lat,
_transmitter_lon,
&bearing, &az2, &distance);
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
//select the nearest valid mobile transmitter
if ( _carrier_valid && _tanker_valid ){
if( carrier_distance <= tanker_distance ){
SG_LOG( SG_INSTR, SG_DEBUG, " select carrier (dist) " );
mobile_bearing = carrier_bearing;
mobile_distance = carrier_distance;
mobile_elevation_ft = _carrier_elevation_ft;
mobile_range_nm = _carrier_range_nm;
mobile_bias = _carrier_bias;
mobile_name = _carrier_name;
}else{
SG_LOG( SG_INSTR, SG_DEBUG, " select tanker (dist) " );
mobile_bearing = tanker_bearing;
mobile_distance = tanker_distance;
mobile_elevation_ft = _tanker_elevation_ft;
mobile_range_nm = _tanker_range_nm;
mobile_bias = _tanker_bias;
mobile_name = _tanker_name;
}
mobile_valid = true;
}
else if ( _carrier_valid && !_tanker_valid ){
SG_LOG( SG_INSTR, SG_DEBUG, " select carrier " );
mobile_bearing = carrier_bearing;
mobile_distance = carrier_distance;
mobile_elevation_ft = _carrier_elevation_ft;
mobile_range_nm = _carrier_range_nm;
mobile_bias = _carrier_bias;
mobile_name = _carrier_name;
mobile_valid = true;
}
else if ( !_carrier_valid && _tanker_valid ){
SG_LOG( SG_INSTR, SG_DEBUG, " select tanker " );
mobile_bearing = tanker_bearing;
mobile_distance = tanker_distance;
mobile_elevation_ft = _tanker_elevation_ft;
mobile_range_nm = _tanker_range_nm;
mobile_bias = _tanker_bias;
mobile_name = _tanker_name;
mobile_valid = true;
}else{
mobile_valid = false;
}
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
//select the nearer
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
if ( mobile_distance <= distance && mobile_valid) {
SG_LOG( SG_INSTR, SG_DEBUG, "mobile_distance_m " << mobile_distance);
SG_LOG( SG_INSTR, SG_DEBUG, "distance_m " << distance);
bearing = mobile_bearing;
distance = mobile_distance;
_transmitter_elevation_ft = mobile_elevation_ft;
_transmitter_range_nm = mobile_range_nm;
_transmitter_bias = mobile_bias;
_transmitter_name = mobile_name;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
_name_node->setStringValue(_transmitter_name.c_str());
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
_channel_node->setStringValue(_channel.c_str());
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
}
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
//// calculate some values for boresight display
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
double distance_nm = distance * SG_METER_TO_NM;
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
//// calculate look left/right to target, without yaw correction
// double horiz_offset = bearing - heading;
//
// if (horiz_offset > 180.0) horiz_offset -= 360.0;
// if (horiz_offset < -180.0) horiz_offset += 360.0;
//// now correct look left/right for yaw
// horiz_offset += yaw;
// use the bearing for plan position indicator display
double horiz_offset = bearing;
SG_LOG( SG_INSTR, SG_DEBUG, "distance_nm " << distance_nm << " bearing "
<< bearing << " horiz_offset " << horiz_offset);
// calculate values for radar display
double y_shift = distance_nm * cos( horiz_offset * SG_DEGREES_TO_RADIANS);
double x_shift = distance_nm * sin( horiz_offset * SG_DEGREES_TO_RADIANS);
SG_LOG( SG_INSTR, SG_DEBUG, "y_shift " << y_shift << " x_shift " << x_shift);
double rotation = 0;
Add missing files.
2005-10-01 11:08:06 +00:00
/*Point3D location =
sgGeodToCart(Point3D(longitude_rad, latitude_rad, altitude_m));
double distance_nm = _transmitter.distance3D(location) * SG_METER_TO_NM;*/
double range_nm = adjust_range(_transmitter_elevation_ft,
altitude_m * SG_METER_TO_FEET,
_transmitter_range_nm);
if (distance_nm <= range_nm) {
double speed_kt = (fabs(distance_nm - _last_distance_nm) *
((1 / delta_time_sec) * 3600.0));
_last_distance_nm = distance_nm;
_in_range_node->setBoolValue(true);
double tmp_dist = distance_nm - _transmitter_bias;
if ( tmp_dist < 0.0 ) {
tmp_dist = 0.0;
}
_distance_node->setDoubleValue( tmp_dist );
_speed_node->setDoubleValue(speed_kt);
_time_node->setDoubleValue(distance_nm/speed_kt*60.0);
_bearing_node->setDoubleValue(bearing);
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
_x_shift_node->setDoubleValue(x_shift);
_y_shift_node->setDoubleValue(y_shift);
_rotation_node->setDoubleValue(rotation);
Add missing files.
2005-10-01 11:08:06 +00:00
} else {
_last_distance_nm = 0;
_in_range_node->setBoolValue(false);
_distance_node->setDoubleValue(0);
_speed_node->setDoubleValue(0);
_time_node->setDoubleValue(0);
_bearing_node->setDoubleValue(0);
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
_x_shift_node->setDoubleValue(0);
_y_shift_node->setDoubleValue(0);
_rotation_node->setDoubleValue(0);
Add missing files.
2005-10-01 11:08:06 +00:00
}
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
// If we can't find a valid station set everything to zero
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
if (!_transmitter_valid && !mobile_valid ) {
Add missing files.
2005-10-01 11:08:06 +00:00
_in_range_node->setBoolValue(false);
_distance_node->setDoubleValue(0);
_speed_node->setDoubleValue(0);
_time_node->setDoubleValue(0);
_bearing_node->setDoubleValue(0);
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
_x_shift_node->setDoubleValue(0);
_y_shift_node->setDoubleValue(0);
_rotation_node->setDoubleValue(0);
Add missing files.
2005-10-01 11:08:06 +00:00
_transmitter_name = "";
_name_node->setStringValue(_transmitter_name.c_str());
Vivian MEAZZA: "add display values for navigation display"
2006-04-26 21:55:42 +00:00
_channel_node->setStringValue(_channel.c_str());
Add missing files.
2005-10-01 11:08:06 +00:00
return;
}
} // end function update
void
TACAN::search (double frequency_mhz, double longitude_rad,
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
double latitude_rad, double altitude_m)
{
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
int number, i;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "tacan freq " << frequency_mhz );
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
// reset search time
_time_before_search_sec = 1.0;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
//try any carriers first
FGNavRecord *carrier_tacan
= globals->get_carrierlist()->findStationByFreq( frequency_mhz );
_carrier_valid = (carrier_tacan != NULL);
if ( _carrier_valid ) {
SG_LOG( SG_INSTR, SG_DEBUG, "carrier transmitter valid " << _carrier_valid );
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
string str1( carrier_tacan->get_name() );
Vivian MEAZZA: bugfix: don't always refer to carrier #0
2005-11-25 18:55:29 +00:00
SGPropertyNode * branch = fgGetNode("ai/models", true);
vector<SGPropertyNode_ptr> carrier = branch->getChildren("carrier");
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
number = carrier.size();
Vivian MEAZZA: bugfix: don't always refer to carrier #0
2005-11-25 18:55:29 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "carrier " << number );
for ( i = 0; i < number; ++i ) {
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
string str2 ( carrier[i]->getStringValue("name", ""));
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "carrier name " << str2 );
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "strings 1 " << str1 << " 2 " << str2 );
unsigned int loc1= str1.find( str2, 0 );
if ( loc1 != string::npos && str2 != "" ) {
SG_LOG( SG_INSTR, SG_DEBUG, " string found" );
Vivian MEAZZA: use coords of tuned in carrier, not of the first one
2005-11-27 17:25:39 +00:00
_carrier_lat = carrier[i]->getDoubleValue("position/latitude-deg");
_carrier_lon = carrier[i]->getDoubleValue("position/longitude-deg");
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
_carrier_elevation_ft = carrier_tacan->get_elev_ft();
_carrier_range_nm = carrier_tacan->get_range();
_carrier_bias = carrier_tacan->get_multiuse();
_carrier_name = carrier_tacan->get_name();
_carrier_valid = 1;
SG_LOG( SG_INSTR, SG_DEBUG, " carrier transmitter valid " << _carrier_valid );
break;
} else {
_carrier_valid = 0;
SG_LOG( SG_INSTR, SG_DEBUG, " carrier transmitter invalid " << _carrier_valid );
}
}
Vivian MEAZZA: bugfix: don't always refer to carrier #0
2005-11-25 18:55:29 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "name " << _carrier_name);
Add missing files.
2005-10-01 11:08:06 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "lat " << _carrier_lat << "lon " << _carrier_lon);
SG_LOG( SG_INSTR, SG_DEBUG, "elev " << _carrier_elevation_ft);
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
} else {
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, " carrier transmitter invalid " << _carrier_valid );
}
Vivian MEAZZA: "Add Air to Air TACAN. With this facility TACAN equipped aircraft can measure the range and bearing of TACAN equipped AI Aircraft. ATM there is only one assigned - callsign ESSO1 on TACAN channel 039X, but this can be easily expanded to include other c/s channel # pairs - just ask me if you want more."
2006-04-19 17:36:41 +00:00
//try any tankers second
FGNavRecord *tanker_tacan
= globals->get_carrierlist()->findStationByFreq( frequency_mhz );
_tanker_valid = (tanker_tacan != NULL);
if ( _tanker_valid ) {
SG_LOG( SG_INSTR, SG_DEBUG, "tanker transmitter valid start " << _tanker_valid );
string str3( tanker_tacan->get_name() );
SGPropertyNode * branch = fgGetNode("ai/models", true);
vector<SGPropertyNode_ptr> tanker = branch->getChildren("aircraft");
number = tanker.size();
SG_LOG( SG_INSTR, SG_DEBUG, "tanker number " << number );
for ( i = 0; i < number; ++i ) {
string str4 ( tanker[i]->getStringValue("callsign", ""));
SG_LOG( SG_INSTR, SG_DEBUG, "tanker callsign " << str4 );
SG_LOG( SG_INSTR, SG_DEBUG, "strings 3 " << str3 << " 4 " << str4 );
unsigned int loc1= str3.find( str4, 0 );
if ( loc1 != string::npos && str4 != "" ) {
SG_LOG( SG_INSTR, SG_DEBUG, " string found" );
_tanker_lat = tanker[i]->getDoubleValue("position/latitude-deg");
_tanker_lon = tanker[i]->getDoubleValue("position/longitude-deg");
_tanker_elevation_ft = tanker[i]->getDoubleValue("position/altitude-ft");
_tanker_range_nm = tanker_tacan->get_range();
_tanker_bias = tanker_tacan->get_multiuse();
_tanker_name = tanker_tacan->get_name();
_tanker_valid = 1;
SG_LOG( SG_INSTR, SG_DEBUG, " tanker transmitter valid " << _tanker_valid );
break;
} else {
_tanker_valid = 0;
SG_LOG( SG_INSTR, SG_DEBUG, " tanker transmitter invalid " << _tanker_valid );
}
}
SG_LOG( SG_INSTR, SG_DEBUG, "tanker name " << _tanker_name);
SG_LOG( SG_INSTR, SG_DEBUG, "lat " << _tanker_lat << "lon " << _tanker_lon);
SG_LOG( SG_INSTR, SG_DEBUG, "elev " << _tanker_elevation_ft);
SG_LOG( SG_INSTR, SG_DEBUG, "range " << _tanker_range_nm);
} else {
SG_LOG( SG_INSTR, SG_DEBUG, " tanker transmitter invalid " << _tanker_valid );
}
Add missing files.
2005-10-01 11:08:06 +00:00
// try the TACAN/VORTAC list next
FGNavRecord *tacan
= globals->get_tacanlist()->findByFreq( frequency_mhz, longitude_rad,
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
latitude_rad, altitude_m);
Add missing files.
2005-10-01 11:08:06 +00:00
_transmitter_valid = (tacan != NULL);
if ( _transmitter_valid ) {
SG_LOG( SG_INSTR, SG_DEBUG, "transmitter valid " << _transmitter_valid );
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
_transmitter_lat = tacan->get_lat();
_transmitter_lon = tacan->get_lon();
_transmitter_elevation_ft = tacan->get_elev_ft();
_transmitter_range_nm = tacan->get_range();
_transmitter_bias = tacan->get_multiuse();
_transmitter_name = tacan->get_name();
_name_node->setStringValue(_transmitter_name.c_str());
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Vivian MEAZZA: bugfix: don't always refer to carrier #0
2005-11-25 18:55:29 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "name " << _transmitter_name);
Add missing files.
2005-10-01 11:08:06 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "lat " << _transmitter_lat << "lon " << _transmitter_lon);
SG_LOG( SG_INSTR, SG_DEBUG, "elev " << _transmitter_elevation_ft);
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
} else {
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "transmitter invalid " << _transmitter_valid );
}
Add missing files.
2005-10-01 11:08:06 +00:00
}
double
Alex Romosan: * Use "const string&" rather than "string" in function calls when appropriate. * Use "const Point3D&" instead of "Pint3D" in function calls when appropriate. * Improved course calculation in calc_gc_course_dist() * Safer thread handling code. Vassilii Khachaturov: Dont use "const Point3D&" for return types unless you're absolutely sure. Erik Hofman: * Use SGD_(2)PI(_[24]) as defined in simgear/constants.h rather than calculating it by hand every time.
2005-10-25 13:49:55 +00:00
TACAN::searchChannel (const string& _channel){
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
double frequency_khz = 0;
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
FGTACANRecord *freq
= globals->get_channellist()->findByChannel( _channel );
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
double _freq_valid = (freq != NULL);
Add missing files.
2005-10-01 11:08:06 +00:00
SG_LOG( SG_INSTR, SG_DEBUG, "freq valid " << _freq_valid );
if ( _freq_valid ) {
frequency_khz = freq->get_freq();
SG_LOG( SG_INSTR, SG_DEBUG, "freq output " << frequency_khz );
//check sanity
Vivian MEAZZA: "Bug fix - ensure all TACAN channels are included"
2006-02-05 11:33:08 +00:00
if (frequency_khz >=9620 && frequency_khz <= 12130)
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
return frequency_khz/100;
Add missing files.
2005-10-01 11:08:06 +00:00
}
return frequency_khz = 0;
} // end TACAN::searchChannel
cosmetics -- NO CODE CHANGE! remove trailing spaces fix very liberal indentation (logical block not indented at all, 5 spaces, ...) removed commented out code
2005-11-25 19:07:24 +00:00
Add missing files.
2005-10-01 11:08:06 +00:00
// end of TACAN.cxx
Copy permalink