#include "tacan.hxx"
using std::vector;
-
+using std::string;
/**
* Adjust the range.
_transmitter_pos(SGGeod::fromDeg(0, 0)),
_transmitter_range_nm(0),
_transmitter_bias(0.0),
- _mobile_lat(0.0),
- _mobile_lon(0.0),
_listener_active(0)
{
}
SGPropertyNode *mnode = fgGetNode("/ai/models/multiplayer", _num, false);
_mp_callsign_node = mnode ? mnode->getChild("callsign", 0, false) : 0;
- _longitude_node = fgGetNode("/position/longitude-deg", true);
- _latitude_node = fgGetNode("/position/latitude-deg", true);
- _altitude_node = fgGetNode("/position/altitude-ft", true);
_heading_node = fgGetNode("/orientation/heading-deg", true);
_yaw_node = fgGetNode("/orientation/side-slip-deg", true);
_electrical_node = fgGetNode("/systems/electrical/outputs/tacan", true);
}
+void
+TACAN::reinit ()
+{
+ _time_before_search_sec = 0;
+}
+
void
TACAN::update (double delta_time_sec)
{
+ // don't do anything when paused
+ if (delta_time_sec == 0) return;
+
if (!_serviceable_node->getBoolValue() || !_electrical_node->getBoolValue()) {
_last_distance_nm = 0;
_in_range_node->setBoolValue(false);
return;
}
- // Get the aircraft position
- double longitude_deg = _longitude_node->getDoubleValue();
- double latitude_deg = _latitude_node->getDoubleValue();
- double altitude_m = _altitude_node->getDoubleValue() * SG_FEET_TO_METER;
- double longitude_rad = longitude_deg * SGD_DEGREES_TO_RADIANS;
- double latitude_rad = latitude_deg * SGD_DEGREES_TO_RADIANS;
-
+ SGGeod pos(globals->get_aircraft_position());
// On timeout, scan again
_time_before_search_sec -= delta_time_sec;
if ((_time_before_search_sec < 0 || _new_frequency) && _frequency_mhz >= 0)
- search(_frequency_mhz, longitude_rad, latitude_rad, altitude_m);
+ search(_frequency_mhz, pos);
// Calculate the distance to the transmitter
double mobile_bearing = 0;
double mobile_distance = 0;
- SG_LOG( SG_INSTR, SG_DEBUG, "mobile_lat " << _mobile_lat);
- SG_LOG( SG_INSTR, SG_DEBUG, "mobile_lon " << _mobile_lon);
SG_LOG( SG_INSTR, SG_DEBUG, "mobile_name " << _mobile_name);
SG_LOG( SG_INSTR, SG_DEBUG, "mobile_valid " << _mobile_valid);
- geo_inverse_wgs_84(altitude_m,
- latitude_deg,
- longitude_deg,
- _mobile_lat,
- _mobile_lon,
+ geo_inverse_wgs_84(pos, _mobilePos,
&mobile_bearing, &mobile_az2, &mobile_distance);
double bearing = 0;
double distance = 0;
- SGGeod pos = SGGeod::fromDegM(longitude_deg, latitude_deg, altitude_m);
geo_inverse_wgs_84(pos, _transmitter_pos,
&bearing, &az2, &distance);
SG_LOG( SG_INSTR, SG_DEBUG, "distance_m " << distance);
bearing = mobile_bearing;
distance = mobile_distance;
- _transmitter_pos.setElevationFt(_mobile_elevation_ft);
+ _transmitter_pos.setElevationFt(_mobilePos.getElevationFt());
_transmitter_range_nm = _mobile_range_nm;
_transmitter_bias = _mobile_bias;
_transmitter_name = _mobile_name;
double rotation = 0;
double range_nm = adjust_range(_transmitter_pos.getElevationFt(),
- altitude_m * SG_METER_TO_FEET,
+ pos.getElevationFt(),
_transmitter_range_nm);
if (distance_nm <= range_nm) {
}
_distance_node->setDoubleValue( tmp_dist );
_speed_node->setDoubleValue(speed_kt);
- _time_node->setDoubleValue(distance_nm/speed_kt*60.0);
+ _time_node->setDoubleValue(speed_kt > 0 ? (distance_nm/speed_kt*60.0) : 0);
_bearing_node->setDoubleValue(bearing);
_x_shift_node->setDoubleValue(x_shift);
_y_shift_node->setDoubleValue(y_shift);
} // end function update
void
-TACAN::search (double frequency_mhz, double longitude_rad,
- double latitude_rad, double altitude_m)
+TACAN::search (double frequency_mhz,const SGGeod& pos)
{
int number, i;
_mobile_valid = false;
_time_before_search_sec = 1.0;
//try any carriers first
- FGNavRecord *mobile_tacan
- = globals->get_carrierlist()->findStationByFreq( frequency_mhz );
+ FGNavRecord *mobile_tacan = FGNavList::findByFreq( frequency_mhz, FGNavList::carrierFilter() );
bool freq_valid = (mobile_tacan != NULL);
SG_LOG( SG_INSTR, SG_DEBUG, "mobile freqency valid " << freq_valid );
number = carrier.size();
SG_LOG( SG_INSTR, SG_DEBUG, "carrier " << number );
- if ( number > 0 ) { // don't do this if there are no carriers
- for ( i = 0; i < number; ++i ) {
- string str2 ( carrier[i]->getStringValue("name", ""));
- SG_LOG( SG_INSTR, SG_DEBUG, "carrier name " << str2 );
-
- SG_LOG( SG_INSTR, SG_DEBUG, "strings 1 " << str1 << " 2 " << str2 );
- string::size_type loc1= str1.find( str2, 0 );
- if ( loc1 != string::npos && str2 != "" ) {
- SG_LOG( SG_INSTR, SG_DEBUG, " string found" );
- _mobile_lat = carrier[i]->getDoubleValue("position/latitude-deg");
- _mobile_lon = carrier[i]->getDoubleValue("position/longitude-deg");
- _mobile_elevation_ft = mobile_tacan->get_elev_ft();
- _mobile_range_nm = mobile_tacan->get_range();
- _mobile_bias = mobile_tacan->get_multiuse();
- _mobile_name = mobile_tacan->name();
- _mobile_ident = mobile_tacan->get_trans_ident();
- _mobile_valid = true;
- SG_LOG( SG_INSTR, SG_DEBUG, " carrier transmitter valid " << _mobile_valid );
- break;
- } else {
- _mobile_valid = false;
- SG_LOG( SG_INSTR, SG_DEBUG, " carrier transmitter invalid " << _mobile_valid );
- }
+ for ( i = 0; i < number; ++i ) {
+ string str2 ( carrier[i]->getStringValue("name", ""));
+ SG_LOG( SG_INSTR, SG_DEBUG, "carrier name " << str2 );
+
+ SG_LOG( SG_INSTR, SG_DEBUG, "strings 1 " << str1 << " 2 " << str2 );
+ string::size_type loc1= str1.find( str2, 0 );
+ if ( loc1 != string::npos && str2 != "" ) {
+ SG_LOG( SG_INSTR, SG_DEBUG, " string found" );
+ _mobilePos = SGGeod::fromDegFt(
+ carrier[i]->getDoubleValue("position/longitude-deg"),
+ carrier[i]->getDoubleValue("position/latitude-deg"),
+ mobile_tacan->get_elev_ft());
+ _mobile_range_nm = mobile_tacan->get_range();
+ _mobile_bias = mobile_tacan->get_multiuse();
+ _mobile_name = mobile_tacan->name();
+ _mobile_ident = mobile_tacan->get_trans_ident();
+ _mobile_valid = true;
+ SG_LOG( SG_INSTR, SG_DEBUG, " carrier transmitter valid " << _mobile_valid );
+ break;
+ } else {
+ _mobile_valid = false;
+ SG_LOG( SG_INSTR, SG_DEBUG, " carrier transmitter invalid " << _mobile_valid );
}
}
SG_LOG( SG_INSTR, SG_DEBUG, "tanker number " << number );
- if ( number > 0 ) { // don't do this if there are no AI aircraft
- 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 1 " << str1 << " 4 " << str4 );
- string::size_type loc1= str1.find( str4, 0 );
- if ( loc1 != string::npos && str4 != "" ) {
- SG_LOG( SG_INSTR, SG_DEBUG, " string found" );
- _mobile_lat = tanker[i]->getDoubleValue("position/latitude-deg");
- _mobile_lon = tanker[i]->getDoubleValue("position/longitude-deg");
- _mobile_elevation_ft = tanker[i]->getDoubleValue("position/altitude-ft");
- _mobile_range_nm = mobile_tacan->get_range();
- _mobile_bias = mobile_tacan->get_multiuse();
- _mobile_name = mobile_tacan->name();
- _mobile_ident = mobile_tacan->get_trans_ident();
- _mobile_valid = true;
- SG_LOG( SG_INSTR, SG_DEBUG, " tanker transmitter valid " << _mobile_valid );
- break;
- } else {
- _mobile_valid = false;
- SG_LOG( SG_INSTR, SG_DEBUG, " tanker transmitter invalid " << _mobile_valid );
- }
+ 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 1 " << str1 << " 4 " << str4 );
+ string::size_type loc1= str1.find( str4, 0 );
+ if ( loc1 != string::npos && str4 != "" ) {
+ SG_LOG( SG_INSTR, SG_DEBUG, " string found" );
+ _mobilePos = SGGeod::fromDegFt(
+ tanker[i]->getDoubleValue("position/longitude-deg"),
+ tanker[i]->getDoubleValue("position/latitude-deg"),
+ tanker[i]->getDoubleValue("position/altitude-ft"));
+
+
+ _mobile_range_nm = mobile_tacan->get_range();
+ _mobile_bias = mobile_tacan->get_multiuse();
+ _mobile_name = mobile_tacan->name();
+ _mobile_ident = mobile_tacan->get_trans_ident();
+ _mobile_valid = true;
+ SG_LOG( SG_INSTR, SG_DEBUG, " tanker transmitter valid " << _mobile_valid );
+ break;
+ } else {
+ _mobile_valid = false;
+ SG_LOG( SG_INSTR, SG_DEBUG, " tanker transmitter invalid " << _mobile_valid );
}
}
}
string::size_type loc1= str1.find( str6, 0 );
if ( loc1 != string::npos && str6 != "" ) {
SG_LOG( SG_INSTR, SG_DEBUG, " string found" );
- _mobile_lat = mp_tanker[i]->getDoubleValue("position/latitude-deg");
- _mobile_lon = mp_tanker[i]->getDoubleValue("position/longitude-deg");
- _mobile_elevation_ft = mp_tanker[i]->getDoubleValue("position/altitude-ft");
+ _mobilePos = SGGeod::fromDegFt(
+ mp_tanker[i]->getDoubleValue("position/longitude-deg"),
+ mp_tanker[i]->getDoubleValue("position/latitude-deg"),
+ mp_tanker[i]->getDoubleValue("position/altitude-ft"));
+
+
_mobile_range_nm = mobile_tacan->get_range();
_mobile_bias = mobile_tacan->get_multiuse();
_mobile_name = mobile_tacan->name();
SG_LOG( SG_INSTR, SG_DEBUG, " mp tanker transmitter valid " << _mobile_valid );
SG_LOG( SG_INSTR, SG_DEBUG, " mp tanker name " << _mobile_name);
- SG_LOG( SG_INSTR, SG_DEBUG, " mp lat " << _mobile_lat << "lon " << _mobile_lon);
- SG_LOG( SG_INSTR, SG_DEBUG, " mp elev " << _mobile_elevation_ft);
SG_LOG( SG_INSTR, SG_DEBUG, " mp range " << _mobile_range_nm);
break;
} else {
}
// try the TACAN/VORTAC list next
- FGNavRecord *tacan = globals->get_tacanlist()->findByFreq( frequency_mhz,
- SGGeod::fromRadM(longitude_rad, latitude_rad, altitude_m));
+ FGNavRecord *tacan = FGNavList::findByFreq( frequency_mhz, pos, FGNavList::tacanFilter() );
_transmitter_valid = (tacan != NULL);
projects / flightgear.git / blobdiff