1
0
Fork 0

Merge branch 'next' of git@gitorious.org:fg/flightgear into next

This commit is contained in:
James Turner 2010-12-27 12:45:07 +00:00
commit a0d1a5cb10
9 changed files with 1 additions and 1640 deletions

View file

@ -31,7 +31,6 @@
#include "commlist.hxx"
#include "ATCDialog.hxx"
#include "ATCutils.hxx"
#include "transmissionlist.hxx"
#include "ground.hxx"
@ -97,14 +96,6 @@ void FGATCMgr::init() {
// -EMH-
// Initialise the ATC Dialogs
//cout << "Initing Transmissions..." << endl;
SG_LOG(SG_ATC, SG_INFO, " ATC Transmissions");
current_transmissionlist = new FGTransmissionList;
SGPath p_transmission( globals->get_fg_root() );
p_transmission.append( "ATC/default.transmissions" );
current_transmissionlist->init( p_transmission );
//cout << "Done Transmissions" << endl;
SG_LOG(SG_ATC, SG_INFO, " ATC Dialog System");
current_atcdialog = new FGATCDialog;
current_atcdialog->Init();
@ -147,12 +138,6 @@ void FGATCMgr::update(double dt) {
// Search the tuned frequencies every now and then - this should be done with the event scheduler
static int i = 0; // Very ugly - but there should only ever be one instance of FGATCMgr.
/*** Area search is defeated. Why?
if(i == 7) {
//cout << "About to AreaSearch()" << endl;
AreaSearch();
}
***/
if(i == 15) {
//cout << "About to search navcomm1" << endl;
FreqSearch("comm", 0);
@ -459,7 +444,6 @@ void FGATCMgr::FreqSearch(const string navcomm, const int unit) {
|| data.type == AWOS) (*atc_list)[svc_name] = new FGATIS;
else if (data.type == TOWER) (*atc_list)[svc_name] = new FGTower;
else if (data.type == GROUND) (*atc_list)[svc_name] = new FGGround;
else if (data.type == APPROACH) (*atc_list)[svc_name] = new FGApproach;
FGATC* svc = (*atc_list)[svc_name];
svc->SetData(&data);
svc->active_on[ncunit] = 1;
@ -471,64 +455,3 @@ void FGATCMgr::FreqSearch(const string navcomm, const int unit) {
ZapOtherService(ncunit, "x x x");
}
}
#ifdef AREA_SEARCH
/* I don't think AreaSearch ever gets called */
// Search ATC stations by area in order that we appear 'on the radar'
void FGATCMgr::AreaSearch() {
const string AREA("AREA");
// Search for Approach stations
comm_list_type approaches;
comm_list_iterator app_itr;
lon = lon_node->getDoubleValue();
lat = lat_node->getDoubleValue();
elev = elev_node->getDoubleValue() * SG_FEET_TO_METER;
for (atc_list_iterator svc = atc_list->begin(); svc != atc_list->end(); svc++) {
MSI &actv = svc->second->active_on;
if (actv.count(AREA)) actv[AREA] = 0; // Mark all as maybe not in range
}
// search stations in range
int num_app = current_commlist->FindByPos(lon, lat, elev, 100.0, &approaches, APPROACH);
if (num_app != 0) {
//cout << num_app << " approaches found in area search !!!!" << endl;
for(app_itr = approaches.begin(); app_itr != approaches.end(); app_itr++) {
FGATC* app = FindInList(app_itr->ident, app_itr->type);
string svc_name = app_itr->ident+decimalNumeral(app_itr->type);
if(app != NULL) {
// The station is already in the ATC list
app->AddPlane("Player");
} else {
// Generate the station and put in the ATC list
FGApproach* a = new FGApproach;
a->SetData(&(*app_itr));
a->AddPlane("Player");
(*atc_list)[svc_name] = a;
//cout << "New area service: " << svc_name << endl;
}
FGATC* svc = (*atc_list)[svc_name];
svc->active_on[AREA] = 1;
}
}
for (atc_list_iterator svc = atc_list->begin(); svc != atc_list->end(); svc++) {
MSI &actv = svc->second->active_on;
if (!actv.count(AREA)) continue;
if (!actv[AREA]) actv.erase(AREA);
if (!actv.size()) { // this service no longer active at all
cout << "Eradicating area service: " << svc->first << endl;
svc->second->SetNoDisplay();
svc->second->Update(0);
delete (svc->second);
atc_list->erase(svc);
// Reset the persistent iterator, since any erase() makes it invalid:
atc_list_itr = atc_list->begin();
// Hope we only move out of one approach-area;
// others will not be noticed until next update:
break;
}
}
}
#endif

View file

@ -32,7 +32,6 @@
#include <map>
#include "tower.hxx"
#include "approach.hxx"
using std::string;
using std::list;
@ -108,8 +107,6 @@ private:
//FGATIS atis;
//FGGround ground;
FGTower tower;
FGApproach approach;
//FGDeparture departure;
// Voice related stuff
bool voice; // Flag - true if we are using voice
@ -173,12 +170,6 @@ private:
// Search the specified radio for stations on the same frequency and in range.
void FreqSearch(const string navcomm, const int unit);
#ifdef AREA_SEARCH
// Search ATC stations by area in order that we appear 'on the radar'
void AreaSearch();
#endif
};
#endif // _FG_ATCMGR_HXX

View file

@ -4,15 +4,12 @@ libATCDCL_a_SOURCES = \
ATC.hxx ATC.cxx \
atis.hxx atis.cxx \
tower.hxx tower.cxx \
approach.hxx approach.cxx \
ground.hxx ground.cxx \
commlist.hxx commlist.cxx \
ATCDialog.hxx ATCDialog.cxx \
ATCVoice.hxx ATCVoice.cxx \
ATCmgr.hxx ATCmgr.cxx \
ATCutils.hxx ATCutils.cxx \
ATCProjection.hxx ATCProjection.cxx \
transmission.hxx transmission.cxx \
transmissionlist.hxx transmissionlist.cxx
ATCProjection.hxx ATCProjection.cxx
INCLUDES = -I$(top_srcdir) -I$(top_srcdir)/src

View file

@ -1,750 +0,0 @@
// FGApproach - a class to provide approach control at larger airports.
//
// Written by Alexander Kappes, started March 2002.
//
// Copyright (C) 2002 Alexander Kappes
//
// 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
#ifdef HAVE_CONFIG_H
# include <config.h>
#endif
#include <iostream>
#include "approach.hxx"
#include "transmission.hxx"
#include "transmissionlist.hxx"
#include "ATCDialog.hxx"
#include <Airports/runways.hxx>
#include <Airports/simple.hxx>
#include <simgear/constants.h>
#include <simgear/misc/sg_path.hxx>
#include <Environment/environment_mgr.hxx>
#include <Environment/environment.hxx>
#include <GUI/gui.h>
using std::cout;
using std::endl;
//Constructor
FGApproach::FGApproach(){
comm1_node = fgGetNode("/instrumentation/comm[0]/frequencies/selected-mhz", true);
comm2_node = fgGetNode("/instrumentation/comm[1]/frequencies/selected-mhz", true);
_type = APPROACH;
num_planes = 0;
lon_node = fgGetNode("/position/longitude-deg", true);
lat_node = fgGetNode("/position/latitude-deg", true);
elev_node = fgGetNode("/position/altitude-ft", true);
hdg_node = fgGetNode("/orientation/heading-deg", true);
speed_node = fgGetNode("/velocities/airspeed-kt", true);
etime_node = fgGetNode("/sim/time/elapsed-sec", true);
first = true;
active_runway = "";
int i;
for ( i=0; i<max_planes; i++) {
planes[i].contact = 0;
planes[i].wpn = 0;
planes[i].dnwp = -999.;
planes[i].on_crs = true;
planes[i].turn_rate = 10.0;
planes[i].desc_rate = 1000.0;
planes[i].clmb_rate = 500.0;
planes[i].tlm = 0.0;
planes[i].lmc.c1 = 0;
planes[i].lmc.c2 = 0;
planes[i].lmc.c3 = -1;
planes[i].wp_change = false;
}
}
//Destructor
FGApproach::~FGApproach(){
}
void FGApproach::Init() {
}
// ============================================================================
// the main update function
// ============================================================================
void FGApproach::Update(double dt) {
const int max_trans = 20;
FGTransmission tmissions[max_trans];
int wpn;
atc_type station = APPROACH;
TransCode code;
TransPar TPar;
int i,j;
//double course, d,
double adif, datp;
//char buf[10];
string message;
//static string atcmsg1[10];
//static string atcmsg2[10];
string mentry;
string transm;
TransPar tpars;
//static bool TransDisplayed = false;
update_plane_dat();
if ( active_runway == "" ) get_active_runway();
double comm1_freq = comm1_node->getDoubleValue();
//bool DisplayTransmissions = true;
for (i=0; i<num_planes; i++) {
if ( planes[i].ident == "Player") {
station = APPROACH;
tpars.station = name;
tpars.callsign = "Player";
tpars.airport = ident;
//cout << "ident = " << ident << " name = " << name << '\n';
int num_trans = 0;
// is the frequency of the station tuned in?
if ( freq == (int)(comm1_freq*100.0 + 0.5) ) {
current_transmissionlist->query_station( station, tmissions, max_trans, num_trans );
// loop over all transmissions for station
for ( j=0; j<=num_trans-1; j++ ) {
code = tmissions[j].get_code();
//cout << "code is " << code.c1 << " " << code.c2 << " " << code.c3 << '\n';
// select proper transmissions
if(code.c3 != 2) { // DCL - hack to prevent request crossing airspace being displayed since this isn't implemented yet.
if ( ( code.c2 == -1 && planes[i].lmc.c3 == 0 ) ||
( code.c1 == 0 && code.c2 == planes[i].lmc.c2 ) ) {
mentry = current_transmissionlist->gen_text(station, code, tpars, false);
transm = current_transmissionlist->gen_text(station, code, tpars, true);
// is the transmission already registered?
if (!current_atcdialog->trans_reg( ident, transm, APPROACH )) {
current_atcdialog->add_entry( ident, transm, mentry, APPROACH, 0 );
}
}
}
}
}
}
}
for ( i=0; i<num_planes; i++ ) {
//cout << "TPar.airport = " << TPar.airport << " TPar.station = " << TPar.station << " TPar.callsign = " << TPar.callsign << '\n';
//if ( planes[i].ident == TPar.callsign && name == TPar.airport && TPar.station == "approach" ) {
//if ( TPar.request && TPar.intention == "landing" && ident == TPar.intid) {
if(planes[i].ident == "Player" && fgGetBool("/sim/atc/opt0")) {
//cout << "Landing requested\n";
fgSetBool("/sim/atc/opt0", false);
planes[i].wpn = 0;
// ===========================
// === calculate waypoints ===
// ===========================
calc_wp( i );
update_param( i );
wpn = planes[i].wpn-1;
planes[i].aalt = planes[i].wpts[wpn-1][2];
planes[i].ahdg = planes[i].wpts[wpn][4];
// generate the message
code.c1 = 1;
code.c2 = 1;
code.c3 = 0;
adif = angle_diff_deg( planes[i].hdg, planes[i].ahdg );
tpars.station = name;
tpars.callsign = "Player";
if ( adif < 0 ) tpars.tdir = 1;
else tpars.tdir = 2;
tpars.heading = planes[i].ahdg;
if (planes[i].alt-planes[i].aalt > 100.0) tpars.VDir = 1;
else if (planes[i].alt-planes[i].aalt < -100.0) tpars.VDir = 3;
else tpars.VDir = 2;
tpars.alt = planes[i].aalt;
message = current_transmissionlist->gen_text(station, code, tpars, true );
//cout << message << '\n';
set_message(message);
planes[i].lmc = code;
planes[i].tlm = etime_node->getDoubleValue();
planes[i].on_crs = true;
planes[i].contact = 1;
}
//}
//if(1) {
if ( planes[i].contact == 1 ) {
// =========================
// === update parameters ===
// =========================
update_param( i );
//cout << planes[i].brg << " " << planes[i].dist << " " << planes[i].wpts[wpn+1][0]
//<< " " << planes[i].wpts[wpn+1][1] << " " << planes[i].wpts[wpn+1][4]
//cout << wpn << " distance to current course = " << planes[i].dcc << endl;
//cout << etime_node->getDoubleValue() << endl;
// =========================
// === reached waypoint? ===
// =========================
wpn = planes[i].wpn-2;
adif = angle_diff_deg( planes[i].hdg, planes[i].wpts[wpn][4] )
* SGD_DEGREES_TO_RADIANS;
datp = 2*sin(fabs(adif)/2.0)*sin(fabs(adif)/2.0) *
planes[i].spd/3600. * planes[i].turn_rate +
planes[i].spd/3600. * 3.0;
//cout << adif/SGD_DEGREES_TO_RADIANS << " "
// << datp << " " << planes[i].dnc << " " << planes[i].dcc <<endl;
if ( fabs(planes[i].dnc) < datp ) {
//if ( fabs(planes[i].dnc) < 0.3 && planes[i].dnwp < 1.0 ) {
//cout << "Reached next waypoint!\n";
planes[i].wpn -= 1;
wpn = planes[i].wpn-1;
planes[i].ahdg = planes[i].wpts[wpn][4];
planes[i].aalt = planes[i].wpts[wpn-1][2];
planes[i].wp_change = true;
// generate the message
adif = angle_diff_deg( planes[i].hdg, planes[i].ahdg );
tpars.station = name;
tpars.callsign = "Player";
if ( adif < 0 ) tpars.tdir = 1;
else tpars.tdir = 2;
tpars.heading = planes[i].ahdg;
if ( wpn-1 != 0) {
code.c1 = 1;
code.c2 = 1;
code.c3 = 0;
if (planes[i].alt-planes[i].aalt > 100.0) tpars.VDir = 1;
else if (planes[i].alt-planes[i].aalt < -100.0) tpars.VDir = 3;
else tpars.VDir = 2;
tpars.alt = planes[i].aalt;
message = current_transmissionlist->gen_text(station, code, tpars, true );
//cout << "Approach transmitting...\n";
//cout << message << endl;
set_message(message);
}
else {
code.c1 = 1;
code.c2 = 3;
code.c3 = 0;
tpars.runway = active_runway;
message = current_transmissionlist->gen_text(station, code, tpars, true);
//cout << "Approach transmitting 2 ...\n";
//cout << message << endl;
set_message(message);
}
planes[i].lmc = code;
planes[i].tlm = etime_node->getDoubleValue();
planes[i].on_crs = true;
update_param( i );
}
// =========================
// === come off course ? ===
// =========================
if ( fabs(planes[i].dcc) > 1.0 &&
( !planes[i].wp_change || etime_node->getDoubleValue() - planes[i].tlm > tbm ) ) {
//cout << "Off course!\n";
if ( planes[i].on_crs ) {
if ( planes[i].dcc < 0) {
planes[i].ahdg += 30.0;
}
else {
planes[i].ahdg -= 30.0;
}
if (planes[i].ahdg > 360.0) planes[i].ahdg -= 360.0;
else if (planes[i].ahdg < 0.0) planes[i].ahdg += 360.0;
}
//cout << planes[i].on_crs << " "
// << angle_diff_deg( planes[i].hdg, planes[i].ahdg) << " "
// << etime_node->getDoubleValue() << " "
// << planes[i].tlm << endl;
// generate the message
if ( planes[i].on_crs ||
( fabs(angle_diff_deg( planes[i].hdg, planes[i].ahdg )) > 30.0 &&
etime_node->getDoubleValue() - planes[i].tlm > tbm) ) {
// generate the message
code.c1 = 1;
code.c2 = 4;
code.c3 = 0;
adif = angle_diff_deg( planes[i].hdg, planes[i].ahdg );
tpars.station = name;
tpars.callsign = "Player";
tpars.miles = fabs(planes[i].dcc);
if ( adif < 0 ) tpars.tdir = 1;
else tpars.tdir = 2;
tpars.heading = planes[i].ahdg;
message = current_transmissionlist->gen_text(station, code, tpars, true);
//cout << "Approach transmitting 3 ...\n";
//cout << message << '\n';
set_message(message);
planes[i].lmc = code;
planes[i].tlm = etime_node->getDoubleValue();
}
planes[i].on_crs = false;
}
else if ( !planes[i].on_crs ) {
//cout << "Off course 2!\n";
wpn = planes[i].wpn-1;
adif = angle_diff_deg( planes[i].hdg, planes[i].wpts[wpn][4] )
* SGD_DEGREES_TO_RADIANS;
datp = 2*sin(fabs(adif)/2.0)*sin(fabs(adif)/2.0) *
planes[i].spd/3600. * planes[i].turn_rate +
planes[i].spd/3600. * 3.0;
if ( fabs(planes[i].dcc) < datp ) {
planes[i].ahdg = fabs(planes[i].wpts[wpn][4]);
// generate the message
code.c1 = 1;
code.c2 = 2;
code.c3 = 0;
tpars.station = name;
tpars.callsign = "Player";
if ( adif < 0 ) tpars.tdir = 1;
else tpars.tdir = 2;
tpars.heading = planes[i].ahdg;
message = current_transmissionlist->gen_text(station, code, tpars, true);
//cout << "Approach transmitting 4 ...\n";
//cout << message << '\n';
set_message(message);
planes[i].lmc = code;
planes[i].tlm = etime_node->getDoubleValue();
planes[i].on_crs = true;
}
}
else if ( planes[i].wp_change ) {
planes[i].wp_change = false;
}
// ===================================================================
// === Less than two minutes away from touchdown? -> Contact Tower ===
// ===================================================================
if ( planes[i].wpn == 2 && planes[i].dnwp < planes[i].spd/60.*2.0 ) {
double freq = 121.95; // Hardwired - FIXME
// generate message
code.c1 = 1;
code.c2 = 5;
code.c3 = 0;
tpars.station = name;
tpars.callsign = "Player";
tpars.freq = freq;
message = current_transmissionlist->gen_text(station, code, tpars, true);
//cout << "Approach transmitting 5 ...\n";
//cout << message << '\n';
set_message(message);
planes[i].lmc = code;
planes[i].tlm = etime_node->getDoubleValue();
planes[i].contact = 2;
}
}
}
}
// ============================================================================
// update course parameters
// ============================================================================
void FGApproach::update_param( const int &i ) {
double course, d;
int wpn = planes[i].wpn-1; // this is the current waypoint
planes[i].dcc = calc_psl_dist(planes[i].brg, planes[i].dist,
planes[i].wpts[wpn][0], planes[i].wpts[wpn][1],
planes[i].wpts[wpn][4]);
planes[i].dnc = calc_psl_dist(planes[i].brg, planes[i].dist,
planes[i].wpts[wpn-1][0], planes[i].wpts[wpn-1][1],
planes[i].wpts[wpn-1][4]);
calc_hd_course_dist(planes[i].brg, planes[i].dist,
planes[i].wpts[wpn-1][0], planes[i].wpts[wpn-1][1],
&course, &d);
planes[i].dnwp = d;
}
// ============================================================================
// smallest difference between two angles in degree
// difference is negative if a1 > a2 and positive if a2 > a1
// ===========================================================================
double FGApproach::angle_diff_deg( const double &a1, const double &a2) {
double a3 = a2 - a1;
if (a3 < 180.0) a3 += 360.0;
if (a3 > 180.0) a3 -= 360.0;
return a3;
}
// ============================================================================
// calculate waypoints
// ============================================================================
void FGApproach::calc_wp( const int &i ) {
int j;
double course, d, cd, a1, az2;
int wpn = planes[i].wpn;
// waypoint 0: Threshold of active runway
SGGeod activeRunway(SGGeod::fromDeg(active_rw_lon, active_rw_lat));
SGGeodesy::inverse(_geod, activeRunway, course, az2, d);
double d1 = active_rw_hdg+180.0;
if ( d1 > 360.0 ) d1 -=360.0;
calc_cd_head_dist(360.0-course, d/SG_NM_TO_METER,
d1, active_rw_len/SG_NM_TO_METER/2.0,
&planes[i].wpts[wpn][0], &planes[i].wpts[wpn][1]);
planes[i].wpts[wpn][2] = _geod.getElevationM();
planes[i].wpts[wpn][4] = 0.0;
planes[i].wpts[wpn][5] = 0.0;
wpn += 1;
// ======================
// horizontal navigation
// ======================
// waypoint 1: point for turning onto final
calc_cd_head_dist(planes[i].wpts[wpn-1][0], planes[i].wpts[wpn-1][1], d1, lfl,
&planes[i].wpts[wpn][0], &planes[i].wpts[wpn][1]);
calc_hd_course_dist(planes[i].wpts[wpn][0], planes[i].wpts[wpn][1],
planes[i].wpts[wpn-1][0], planes[i].wpts[wpn-1][1],
&course, &d);
planes[i].wpts[wpn][4] = course;
planes[i].wpts[wpn][5] = d;
wpn += 1;
// calculate course and distance from plane position to waypoint 1
calc_hd_course_dist(planes[i].brg, planes[i].dist, planes[i].wpts[1][0],
planes[i].wpts[1][1], &course, &d);
// check if airport is not between plane and waypoint 1 and
// DCA to airport on course to waypoint 1 is larger than 10 miles
double zero = 0.0;
if ( fabs(angle_diff_deg( planes[i].wpts[1][0], planes[i].brg )) < 90.0 ||
calc_psl_dist( zero, zero, planes[i].brg, planes[i].dist, course ) > 10.0 ) {
// check if turning angle at waypoint 1 would be > max_ta
if ( fabs(angle_diff_deg( planes[i].wpts[1][4], course )) > max_ta ) {
cd = calc_psl_dist(planes[i].brg, planes[i].dist,
planes[i].wpts[1][0], planes[i].wpts[1][1],
planes[i].wpts[1][4]);
a1 = atan2(cd,planes[i].wpts[1][1]);
planes[i].wpts[wpn][0] = planes[i].wpts[1][0] - a1/SGD_DEGREES_TO_RADIANS;
if ( planes[i].wpts[wpn][0] < 0.0) planes[i].wpts[wpn][0] += 360.0;
if ( planes[i].wpts[wpn][0] > 360.0) planes[i].wpts[wpn][0] -= 360.0;
planes[i].wpts[wpn][1] = fabs(cd) / sin(fabs(a1));
calc_hd_course_dist(planes[i].wpts[wpn][0], planes[i].wpts[wpn][1],
planes[i].wpts[wpn-1][0], planes[i].wpts[wpn-1][1],
&course, &d);
planes[i].wpts[wpn][4] = course;
planes[i].wpts[wpn][5] = d;
wpn += 1;
calc_hd_course_dist(planes[i].brg, planes[i].dist, planes[i].wpts[wpn-1][0],
planes[i].wpts[wpn-1][1], &course, &d);
}
} else {
double leg = 10.0;
a1 = atan2(planes[i].wpts[1][1], leg );
if ( angle_diff_deg(planes[i].brg,planes[i].wpts[1][0]) < 0 )
planes[i].wpts[wpn][0] = planes[i].wpts[1][0] + a1/SGD_DEGREES_TO_RADIANS;
else planes[i].wpts[wpn][0] = planes[i].wpts[1][0] - a1/SGD_DEGREES_TO_RADIANS;
planes[i].wpts[wpn][1] = sqrt( planes[i].wpts[1][1]*planes[i].wpts[1][1] + leg*leg );
calc_hd_course_dist(planes[i].wpts[wpn][0], planes[i].wpts[wpn][1],
planes[i].wpts[wpn-1][0], planes[i].wpts[wpn-1][1],
&course, &d);
planes[i].wpts[wpn][4] = course;
planes[i].wpts[wpn][5] = d;
wpn += 1;
calc_hd_course_dist(planes[i].brg, planes[i].dist,
planes[i].wpts[wpn-1][0], planes[i].wpts[wpn-1][1],
&course, &d);
}
planes[i].wpts[wpn][0] = planes[i].brg;
planes[i].wpts[wpn][1] = planes[i].dist;
planes[i].wpts[wpn][2] = planes[i].alt;
planes[i].wpts[wpn][4] = course;
planes[i].wpts[wpn][5] = d;
wpn += 1;
planes[i].wpn = wpn;
// Now check if legs are too short or if legs can be shortend
// legs must be at least 2 flight minutes long
double mdist = planes[i].spd / 60.0 * 2.0;
for ( j=2; j<wpn-1; ++j ) {
if ( planes[i].wpts[j][1] < mdist) {
}
}
// ====================
// vertical navigation
// ====================
double alt = _geod.getElevationM()+3000.0;
planes[i].wpts[1][2] = round_alt( true, alt );
for ( j=2; j<wpn-1; ++j ) {
double dalt = planes[i].alt - planes[i].wpts[j-1][2];
if ( dalt > 0 ) {
alt = planes[i].wpts[j-1][2] +
(planes[i].wpts[j][5] / planes[i].spd) * 60.0 * planes[i].desc_rate;
planes[i].wpts[j][2] = round_alt( false, alt );
if ( planes[i].wpts[j][2] > planes[i].alt )
planes[i].wpts[j][2] = round_alt( false, planes[i].alt );
}
else {
planes[i].wpts[j][2] = planes[i].wpts[1][2];
}
}
cout << "Plane position: " << planes[i].brg << " " << planes[i].dist << endl;
for ( j=0; j<wpn; ++j ) {
cout << "Waypoint " << j << endl;
cout << "------------------" << endl;
cout << planes[i].wpts[j][0] << " " << planes[i].wpts[j][1]
<< " " << planes[i].wpts[j][2] << " " << planes[i].wpts[j][5];
cout << endl << endl;
}
}
// ============================================================================
// round altitude value to next highest/lowest 500 feet
// ============================================================================
double FGApproach::round_alt( const bool hl, double alt ) {
alt = alt/1000.0;
if ( hl ) {
if ( alt > (int)(alt)+0.5 ) alt = ((int)(alt)+1)*1000.0;
else alt = ((int)(alt)+0.5)*1000.0;
}
else {
if ( alt > (int)(alt)+0.5 ) alt = ((int)(alt)+0.5)*1000.0;
else alt = ((int)(alt))*1000.0;
}
return alt;
}
// ============================================================================
// get active runway
// ============================================================================
void FGApproach::get_active_runway() {
//cout << "Entering FGApproach::get_active_runway()\n";
const FGAirport* apt = fgFindAirportID(ident);
assert(apt);
FGRunway* runway = apt->getActiveRunwayForUsage();
active_runway = runway->ident();
active_rw_hdg = runway->headingDeg();
active_rw_lon = runway->longitude();
active_rw_lat = runway->latitude();
active_rw_len = runway->lengthFt();
}
// ========================================================================
// update infos about plane
// ========================================================================
void FGApproach::update_plane_dat() {
//cout << "Update Approach " << ident << " " << num_planes << " registered" << endl;
// update plane positions
int i;
for (i=0; i<num_planes; i++) {
planes[i].lon = lon_node->getDoubleValue();
planes[i].lat = lat_node->getDoubleValue();
planes[i].alt = elev_node->getDoubleValue();
planes[i].hdg = hdg_node->getDoubleValue();
planes[i].spd = speed_node->getDoubleValue();
double course, distance, az2;
SGGeod plane(SGGeod::fromDeg(planes[1].lon, active_rw_lat));
SGGeodesy::inverse(_geod, plane, course, az2, distance);
planes[i].dist = distance * SG_METER_TO_NM;
planes[i].brg = 360.0-course;
//cout << "Plane Id: " << planes[i].ident << " Distance to " << ident
// << " is " << planes[i].dist << " miles " << "Bearing " << planes[i].brg << endl;
}
}
// =======================================================================
// Add plane to Approach list
// =======================================================================
void FGApproach::AddPlane(const string& pid) {
int i;
for ( i=0; i<num_planes; i++) {
if ( planes[i].ident == pid) {
//cout << "Plane already registered: " << planes[i].ident << ' ' << ident << ' ' << num_planes << endl;
return;
}
}
planes[num_planes].ident = pid;
++num_planes;
//cout << "Plane added to list: " << ident << " " << num_planes << endl;
return;
}
// ================================================================================
// closest distance between a point (h1,d1) and a straigt line (h2,d2,h3) in 2 dim.
// ================================================================================
double FGApproach::calc_psl_dist(const double &h1, const double &d1,
const double &h2, const double &d2,
const double &h3)
{
double a1 = h1 * SGD_DEGREES_TO_RADIANS;
double a2 = h2 * SGD_DEGREES_TO_RADIANS;
double a3 = h3 * SGD_DEGREES_TO_RADIANS;
double x1 = cos(a1) * d1;
double y1 = sin(a1) * d1;
double x2 = cos(a2) * d2;
double y2 = sin(a2) * d2;
double x3 = cos(a3);
double y3 = sin(a3);
// formula: dis = sqrt( (v1-v2)**2 - ((v1-v2)*v3)**2 ); vi = (xi,yi)
double val1 = (x1-x2)*(x1-x2) + (y1-y2)*(y1-y2);
double val2 = ((x1-x2)*x3 + (y1-y2)*y3) * ((x1-x2)*x3 + (y1-y2)*y3);
double dis = val1 - val2;
// now get sign for offset
//cout << x1 << " " << x2 << " " << y1 << " " << y2 << " "
// << x3 << " " << y3 << " "
// << val1 << " " << val2 << " " << dis << endl;
x3 *= sqrt(val2);
y3 *= sqrt(val2);
double da = fabs(atan2(y3,x3) - atan2(y1-y2,x1-x2));
if ( da > SGD_PI ) da -= SGD_2PI;
if ( fabs(da) > SGD_PI_2) {
//if ( x3*(x1-x2) < 0.0 && y3*(y1-y2) < 0.0) {
x3 *= -1.0;
y3 *= -1.0;
}
//cout << x3 << " " << y3 << endl;
double dis1 = x1-x2-x3;
double dis2 = y1-y2-y3;
dis = sqrt(dis);
da = atan2(dis2,dis1);
if ( da < 0.0 ) da += SGD_2PI;
if ( da < a3 ) dis *= -1.0;
//cout << dis1 << " " << dis2 << " " << da*SGD_RADIANS_TO_DEGREES << " " << h3
// << " " << sqrt(dis1*dis1 + dis2*dis2) << " " << dis << endl;
//cout << atan2(dis2,dis1)*SGD_RADIANS_TO_DEGREES << " " << dis << endl;
return dis;
}
// ========================================================================
// Calculate new bear/dist given starting bear/dis, and offset radial,
// and distance.
// ========================================================================
void FGApproach::calc_cd_head_dist(const double &h1, const double &d1,
const double &course, const double &dist,
double *h2, double *d2)
{
double a1 = h1 * SGD_DEGREES_TO_RADIANS;
double a2 = course * SGD_DEGREES_TO_RADIANS;
double x1 = cos(a1) * d1;
double y1 = sin(a1) * d1;
double x2 = cos(a2) * dist;
double y2 = sin(a2) * dist;
*d2 = sqrt((x1+x2)*(x1+x2) + (y1+y2)*(y1+y2));
*h2 = atan2( (y1+y2), (x1+x2) ) * SGD_RADIANS_TO_DEGREES;
if ( *h2 < 0 ) *h2 = *h2+360;
}
// ========================================================================
// get heading and distance between two points; point1 ---> point2
// ========================================================================
void FGApproach::calc_hd_course_dist(const double &h1, const double &d1,
const double &h2, const double &d2,
double *course, double *dist)
{
double a1 = h1 * SGD_DEGREES_TO_RADIANS;
double a2 = h2 * SGD_DEGREES_TO_RADIANS;
double x1 = cos(a1) * d1;
double y1 = sin(a1) * d1;
double x2 = cos(a2) * d2;
double y2 = sin(a2) * d2;
*dist = sqrt( (y2-y1)*(y2-y1) + (x2-x1)*(x2-x1) );
*course = atan2( (y2-y1), (x2-x1) ) * SGD_RADIANS_TO_DEGREES;
if ( *course < 0 ) *course = *course+360;
//cout << x1 << " " << y1 << " " << x2 << " " << y2 << " " << *dist << " " << *course << endl;
}
int FGApproach::RemovePlane() {
// first check if anything has to be done
bool rmplane = false;
int i;
for (i=0; i<num_planes; i++) {
if (planes[i].dist > range*SG_NM_TO_METER) {
rmplane = true;
break;
}
}
if (!rmplane) return num_planes;
// now make a copy of the plane list
PlaneApp tmp[max_planes];
for (i=0; i<num_planes; i++) {
tmp[i] = planes[i];
}
int np = 0;
// now check which planes are still in range
for (i=0; i<num_planes; i++) {
if (tmp[i].dist <= range*SG_NM_TO_METER) {
planes[np] = tmp[i];
np += 1;
}
}
num_planes = np;
return num_planes;
}
void FGApproach::set_message(const string &msg)
{
fgSetString("/sim/messages/approach", msg.c_str());
}

View file

@ -1,215 +0,0 @@
// approach.hxx -- Approach class
//
// Written by Alexander Kappes, started March 2002.
//
// Copyright (C) 2002 Alexander Kappes
//
// 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
#ifndef _FG_APPROACH_HXX
#define _FG_APPROACH_HXX
#include <stdio.h>
#include <simgear/compiler.h>
#include <simgear/math/sg_geodesy.hxx>
#include <simgear/misc/sgstream.hxx>
#include <simgear/magvar/magvar.hxx>
#include <simgear/timing/sg_time.hxx>
#include <simgear/bucket/newbucket.hxx>
#include <Main/fg_props.hxx>
# include <iosfwd>
#include "ATC.hxx"
#include "transmission.hxx"
//DCL - a complete guess for now.
#define FG_APPROACH_DEFAULT_RANGE 100
// Contains all the information about a plane that the approach control needs
const int max_planes = 20; // max number of planes on the stack
const int max_wp = 10; // max number of waypoints for approach phase
const double max_ta = 130; // max turning angle for plane during approach
const double tbm = 2.0; // min time (in sec) between two messages
const double lfl = 10.0; // length of final leg
struct PlaneApp {
// variables for plane if it's on the radar
std::string ident; // indentification of plane
double lon; // longitude in degrees
double lat; // latitude in degrees
double alt; // Altitute above sea level in feet
double hdg; // heading of plane in degrees
double dist; // distance to airport in miles
double brg; // bearing relative to airport in degrees
double spd; // speed above ground
int contact; // contact with approach established?
// 0 = no contact yet
// 1 = in contact
// 2 = handed off to tower
double turn_rate; // standard turning rate of the plane in seconds per degree
double desc_rate; // standard descent rate of the plane in feets per minute
double clmb_rate; // standard climb rate of the plane in feets per minute
// additional variables if contact has been established
int wpn; // number of waypoints
double wpts[max_wp][6]; // assigned waypoints for approach phase
// first wp in list is airport
// last waypoint point at which contact was established
// second index: 0 = bearing to airport
// second index: 1 = distance to airport
// second index: 2 = alt
// second index: 3 = ETA
// second index: 4 = heading to next waypoint
// second index: 5 = distance to next waypoint
double dnwp; // distance to next waypoint
double dcc; // closest distance to current assigned course
double dnc; // closest distance to course from next to next to next wp
double aalt; // assigned altitude
double ahdg; // assigned heading
bool on_crs; // is the plane on course?
bool wp_change; // way point has changed
double tlm; // time when last message was sent
TransCode lmc; // code of last message
};
class FGApproach : public FGATC {
int bucket;
std::string active_runway;
double active_rw_hdg;
double active_rw_lon;
double active_rw_lat;
double active_rw_len;
int num_planes; // number of planes on the stack
PlaneApp planes[max_planes]; // Array of planes
std::string transmission;
bool first;
SGPropertyNode_ptr comm1_node;
SGPropertyNode_ptr comm2_node;
SGPropertyNode_ptr atcmenu_node;
SGPropertyNode_ptr atcopt0_node;
SGPropertyNode_ptr atcopt1_node;
SGPropertyNode_ptr atcopt2_node;
SGPropertyNode_ptr atcopt3_node;
SGPropertyNode_ptr atcopt4_node;
SGPropertyNode_ptr atcopt5_node;
SGPropertyNode_ptr atcopt6_node;
SGPropertyNode_ptr atcopt7_node;
SGPropertyNode_ptr atcopt8_node;
SGPropertyNode_ptr atcopt9_node;
// for failure modeling
std::string trans_ident; // transmitted ident
bool approach_failed; // approach failed?
public:
FGApproach(void);
~FGApproach(void);
void Init();
void Update(double dt);
// Add new plane to stack if not already registered
// Input: pid - id of plane (name)
// Output: "true" if added; "false" if already existend
void AddPlane(const std::string& pid);
// Remove plane from stack if out of range
int RemovePlane();
inline double get_bucket() const { return bucket; }
inline int get_pnum() const { return num_planes; }
inline const std::string& get_trans_ident() { return trans_ident; }
private:
void calc_wp( const int &i);
void update_plane_dat();
void get_active_runway();
void update_param(const int &i);
double round_alt( bool hl, double alt );
double angle_diff_deg( const double &a1, const double &a2);
void set_message(const std::string &s);
// ========================================================================
// get point2 given starting point1 and course and distance
// input: point1 = heading in degrees, distance
// input: course in degrees, distance
// output: point2 = heading in degrees, distance
// ========================================================================
void calc_cd_head_dist(const double &h1, const double &d1,
const double &course, const double &dist,
double *h2, double *d2);
// ========================================================================
// get heading and distance between two points; point2 ---> point1
// input: point1 = heading in degrees, distance
// input: point2 = heading in degrees, distance
// output: course in degrees, distance
// ========================================================================
void calc_hd_course_dist(const double &h1, const double &d1,
const double &h2, const double &d2,
double *course, double *dist);
// ========================================================================
// closest distance between a point and a straigt line in 2 dim.
// the input variables are given in (heading, distance)
// relative to a common point
// input: point = heading in degrees, distance
// input: straigt line = anker vector (heading in degrees, distance),
// heading of direction vector
// output: distance
// ========================================================================
double calc_psl_dist(const double &h1, const double &d1,
const double &h2, const double &d2,
const double &h3);
// Pointers to current users position
SGPropertyNode_ptr lon_node;
SGPropertyNode_ptr lat_node;
SGPropertyNode_ptr elev_node;
SGPropertyNode_ptr hdg_node;
SGPropertyNode_ptr speed_node;
SGPropertyNode_ptr etime_node;
//Update the transmission string
void UpdateTransmission(void);
friend std::istream& operator>> ( std::istream&, FGApproach& );
};
#endif // _FG_APPROACH_HXX

View file

@ -1,103 +0,0 @@
// FGTransmission - a class to provide transmission control at larger airports.
//
// Written by Alexander Kappes, started March 2002.
// Based on ground.cxx by David Luff, started March 2002.
//
// Copyright (C) 2002 David C. Luff - david.luff@nottingham.ac.uk
//
// 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
#ifdef HAVE_CONFIG_H
# include <config.h>
#endif
#include "transmission.hxx"
#include <cstring>
#include <simgear/debug/logstream.hxx>
#include <simgear/misc/sg_path.hxx>
//Constructor
FGTransmission::FGTransmission(){
}
//Destructor
FGTransmission::~FGTransmission(){
}
void FGTransmission::Init() {
}
// ============================================================================
// extract parameters from transmission
// ============================================================================
TransPar FGTransmission::Parse() {
TransPar tpar;
string tokens[20];
int msglen,toklen;
//char dum;
int i,j,k;
const char *capl = "ABCDEFGHIJKLMNOPQRSTUVWXYZ";
msglen = strlen( TransText.c_str() );
int tkn = 0;
for ( i=0; i < msglen; ++i ) {
if ( TransText.c_str()[i] != ' ' ) {
if ( TransText.c_str()[i] != ',' ) tokens[tkn] += TransText.c_str()[i];
} else if ( !tokens[tkn].empty() ) {
if ( tkn <= 20 ) {
tkn += 1;
} else {
SG_LOG(SG_ATC, SG_WARN,"Too many tokens");
}
}
}
for ( i=0; i<20; ++i) {
if ( tokens[i] == "request" ) {
tpar.request = true;
} else if ( tokens[i] == "approach" ) {
tpar.station = "approach";
tpar.airport = tokens[i-1];
} else if ( tokens[i] == "landing" ) {
tpar.intention = "landing";
for ( j=i+1; j<=i+2; ++j ) {
if ( !tokens[j].empty() ) {
toklen = strlen( tokens[j].c_str() );
bool aid = true;
for ( k=0; k<toklen; ++k )
if ( ! strpbrk( &tokens[j].c_str()[k], capl )) {
aid = false;
break;
}
if ( aid ) tpar.intid = tokens[j];
}
}
} else if ( tokens[i] == "Player" ) {
tpar.callsign = tokens[i];
}
}
//cout << tpar.airport << endl;
//cout << tpar.request << endl;
//cout << tpar.intention << endl;
//cout << tpar.intid << endl;
return tpar;
}

View file

@ -1,153 +0,0 @@
// transmission.hxx -- Transmission class
//
// Written by Alexander Kappes, started March 2002.
// Based on nav.hxx by Curtis Olson, started April 2000.
//
// Copyright (C) 2001 David C. Luff - david.luff@nottingham.ac.uk
//
// 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
#ifndef _FG_TRANSMISSION_HXX
#define _FG_TRANSMISSION_HXX
#include <stdio.h>
#include <simgear/compiler.h>
#include <simgear/math/sg_geodesy.hxx>
#include <simgear/misc/sgstream.hxx>
#include <simgear/magvar/magvar.hxx>
#include <simgear/timing/sg_time.hxx>
#include <simgear/bucket/newbucket.hxx>
#include <Main/fg_props.hxx>
# include <istream>
#include "ATC.hxx"
struct TransCode {
int c1;
int c2;
int c3;
};
// TransPar - a representation of the logic of a parsed speech transmission
struct TransPar {
std::string station;
std::string callsign;
std::string airport;
std::string intention; // landing, crossing
std::string intid; // (airport) ID for intention
bool request; // is the transmission a request or an answer?
int tdir; // turning direction: 1=left, 2=right
double heading;
int VDir; // vertical direction: 1=descent, 2=maintain, 3=climb
double alt;
double miles;
std::string runway;
double freq;
double time;
};
// FGTransmission - a class to encapsulate a speech transmission
class FGTransmission {
//int StationType; // Type of ATC station: 1 Approach
atc_type StationType;
TransCode Code; // DCL - no idea what this is.
std::string TransText; // The text of the spoken transmission
std::string MenuText; // An abbreviated version of the text for the menu entry
public:
FGTransmission(void);
~FGTransmission(void);
void Init();
inline atc_type get_station() const { return StationType; }
inline const TransCode& get_code() { return Code; }
inline const std::string& get_transtext() { return TransText; }
inline const std::string& get_menutext() { return MenuText; }
// Return the parsed logic of the transmission
TransPar Parse();
private:
friend std::istream& operator>> ( std::istream&, FGTransmission& );
};
inline std::istream&
operator >> ( std::istream& in, FGTransmission& a ) {
char ch;
int tmp;
static bool first_time = true;
static double julian_date = 0;
static const double MJD0 = 2415020.0;
if ( first_time ) {
julian_date = sgTimeCurrentMJD(0, 0) + MJD0;
first_time = false;
}
// Ugly hack alert - eventually we'll use xml format for the transmissions file
in >> tmp;
if(tmp == 1) {
a.StationType = APPROACH;
} else {
a.StationType = INVALID;
}
in >> a.Code.c1;
in >> a.Code.c2;
in >> a.Code.c3;
a.TransText = "";
in >> ch;
if ( ch != '"' ) a.TransText += ch;
while(1) {
//in >> noskipws
in.unsetf(ios::skipws);
in >> ch;
if ( ch != '"' ) a.TransText += ch;
if((ch == '"') || (ch == 0x0A)) {
break;
} // we shouldn't need the 0x0A but it makes a nice safely in case someone leaves off the "
}
in.setf(ios::skipws);
a.MenuText = "";
in >> ch;
if ( ch != '"' ) a.MenuText += ch;
while(1) {
//in >> noskipws
in.unsetf(ios::skipws);
in >> ch;
if ( ch != '"' ) a.MenuText += ch;
if((ch == '"') || (ch == 0x0A)) {
break;
} // we shouldn't need the 0x0A but it makes a nice safely in case someone leaves off the "
}
in.setf(ios::skipws);
//cout << "Code = " << a.Code << " Transmission text = " << a.TransText
// << " Menu text = " << a.MenuText << endl;
return in >> skipeol;
}
#endif // _FG_TRANSMISSION_HXX

View file

@ -1,247 +0,0 @@
// transmissionlist.cxx -- transmission management class
//
// Written by Alexander Kappes, started March 2002.
// Based on navlist.cxx by Curtis Olson, started April 2000.
//
// Copyright (C) 2000 Curtis L. Olson - http://www.flightgear.org/~curt
//
// 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
//
// $Id$
#ifdef HAVE_CONFIG_H
# include <config.h>
#endif
#ifdef HAVE_STRINGS_H
# include <strings.h> // bcopy()
#else
# include <string.h> // MSVC doesn't have strings.h
#endif
#include <simgear/debug/logstream.hxx>
#include <simgear/misc/sgstream.hxx>
#include <simgear/math/sg_geodesy.hxx>
#include "transmissionlist.hxx"
#include <GUI/gui.h>
FGTransmissionList *current_transmissionlist;
FGTransmissionList::FGTransmissionList( void ) {
}
FGTransmissionList::~FGTransmissionList( void ) {
}
// load default.transmissions
bool FGTransmissionList::init( const SGPath& path ) {
FGTransmission a;
transmissionlist_station.erase( transmissionlist_station.begin(), transmissionlist_station.end() );
sg_gzifstream in( path.str() );
if ( !in.is_open() ) {
SG_LOG( SG_GENERAL, SG_ALERT, "Cannot open file: " << path.str() );
exit(-1);
}
// read in each line of the file
// in >> skipeol;
// in >> skipcomment;
double min = 100000;
double max = 0;
while ( ! in.eof() ) {
in >> a;
transmissionlist_station[a.get_station()].push_back(a);
in >> skipcomment;
if ( a.get_station() < min ) {
min = a.get_station();
}
if ( a.get_station() > max ) {
max = a.get_station();
}
/*
cout << a.get_station() << " " << a.get_code().c1 << " " << a.get_code().c2 << " "
<< a.get_code().c3 << " " << a.get_transtext()
<< " " << a.get_menutext() << endl;
*/
}
// init ATC menu
fgSetBool("/sim/atc/menu",false);
return true;
}
// query the database for the specified station type;
// for station see FlightGear/ATC/default.transmissions
bool FGTransmissionList::query_station( const atc_type &station, FGTransmission *t,
int max_trans, int &num_trans )
{
transmission_list_type tmissions = transmissionlist_station[station];
transmission_list_iterator current = tmissions.begin();
transmission_list_iterator last = tmissions.end();
for ( ; current != last ; ++current ) {
if (num_trans < max_trans) {
t[num_trans] = *current;
num_trans += 1;
}
else {
SG_LOG(SG_GENERAL, SG_WARN, "Transmissionlist error: Too many transmissions");
}
}
if ( num_trans != 0 ) return true;
else {
SG_LOG(SG_GENERAL, SG_WARN, "No transmission with station " << station << "found.");
string empty;
return false;
}
}
string FGTransmissionList::gen_text(const atc_type &station, const TransCode code,
const TransPar &tpars, const bool ttext )
{
const int cmax = 300;
string message;
char tag[4];
char crej = '@';
char mes[cmax];
char dum[cmax];
//char buf[10];
char *pos;
int len;
FGTransmission t;
// if (current_transmissionlist->query_station( station, &t ) ) {
transmission_list_type tmissions = transmissionlist_station[station];
transmission_list_iterator current = tmissions.begin();
transmission_list_iterator last = tmissions.end();
for ( ; current != last ; ++current ) {
if ( current->get_code().c1 == code.c1 &&
current->get_code().c2 == code.c2 &&
current->get_code().c3 == code.c3 ) {
if ( ttext ) message = current->get_transtext();
else message = current->get_menutext();
strcpy( &mes[0], message.c_str() );
// Replace all the '@' parameters with the actual text.
int check = 0; // If mes gets overflowed the while loop can go infinite
while ( strchr(&mes[0], crej) != NULL ) { // ie. loop until no more occurances of crej ('@') found
pos = strchr( &mes[0], crej );
memmove(&tag[0], pos, 3);
tag[3] = '\0';
int i;
len = 0;
for ( i=0; i<cmax; i++ ) {
if ( mes[i] == crej ) {
len = i;
break;
}
}
strncpy( &dum[0], &mes[0], len );
dum[len] = '\0';
if ( strcmp ( tag, "@ST" ) == 0 )
strcat( &dum[0], tpars.station.c_str() );
else if ( strcmp ( tag, "@AP" ) == 0 )
strcat( &dum[0], tpars.airport.c_str() );
else if ( strcmp ( tag, "@CS" ) == 0 )
strcat( &dum[0], tpars.callsign.c_str() );
else if ( strcmp ( tag, "@TD" ) == 0 ) {
if ( tpars.tdir == 1 ) {
char buf[] = "left";
strcat( &dum[0], &buf[0] );
}
else {
char buf[] = "right";
strcat( &dum[0], &buf[0] );
}
}
else if ( strcmp ( tag, "@HE" ) == 0 ) {
char buf[10];
sprintf( buf, "%i", (int)(tpars.heading) );
strcat( &dum[0], &buf[0] );
}
else if ( strcmp ( tag, "@VD" ) == 0 ) {
if ( tpars.VDir == 1 ) {
char buf[] = "Descend and maintain";
strcat( &dum[0], &buf[0] );
}
else if ( tpars.VDir == 2 ) {
char buf[] = "Maintain";
strcat( &dum[0], &buf[0] );
}
else if ( tpars.VDir == 3 ) {
char buf[] = "Climb and maintain";
strcat( &dum[0], &buf[0] );
}
}
else if ( strcmp ( tag, "@AL" ) == 0 ) {
char buf[10];
sprintf( buf, "%i", (int)(tpars.alt) );
strcat( &dum[0], &buf[0] );
}
else if ( strcmp ( tag, "@MI" ) == 0 ) {
char buf[10];
sprintf( buf, "%3.1f", tpars.miles );
strcat( &dum[0], &buf[0] );
}
else if ( strcmp ( tag, "@FR" ) == 0 ) {
char buf[10];
sprintf( buf, "%6.2f", tpars.freq );
strcat( &dum[0], &buf[0] );
}
else if ( strcmp ( tag, "@RW" ) == 0 )
strcat( &dum[0], tpars.runway.c_str() );
else {
SG_LOG(SG_GENERAL, SG_WARN, "Tag " << tag << " not found");
break;
}
strcat( &dum[0], &mes[len+3] );
strcpy( &mes[0], &dum[0] );
++check;
if(check > 10) {
SG_LOG(SG_GENERAL, SG_WARN, "WARNING: Possibly endless loop terminated in FGTransmissionlist::gen_text(...)");
break;
}
}
//cout << mes << endl;
break;
}
}
return mes[0] ? mes : "No transmission found";
}

View file

@ -1,82 +0,0 @@
// transmissionlist.hxx -- transmission management class
//
// Written by Alexander Kappes, started March 2002.
// Based on navlist.hxx by Curtis Olson, started April 2000.
//
// Copyright (C) 2000 Curtis L. Olson - http://www.flightgear.org/~curt
//
// 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
//
#ifndef _FG_TRANSMISSIONLIST_HXX
#define _FG_TRANSMISSIONLIST_HXX
#include <simgear/compiler.h>
#include <simgear/misc/sg_path.hxx>
#include <map>
#include <vector>
#include "ATC.hxx"
#include "transmission.hxx"
using std::map;
using std::vector;
class FGTransmissionList {
// convenience types
typedef vector < FGTransmission > transmission_list_type;
typedef transmission_list_type::iterator transmission_list_iterator;
typedef transmission_list_type::const_iterator transmission_list_const_iterator;
// Map of transmission lists by station type
// typedef map < int, transmission_list_type, less<int> > transmission_map_type;
typedef map < atc_type, transmission_list_type > transmission_map_type;
typedef transmission_map_type::iterator transmission_map_iterator;
typedef transmission_map_type::const_iterator transmission_map_const_iterator;
transmission_map_type transmissionlist_station;
public:
FGTransmissionList();
~FGTransmissionList();
// load the transmission data and build the map
bool init( const SGPath& path );
// query the database for the specified code,
bool query_station( const atc_type &station, FGTransmission *a, int max_trans, int &num_trans );
// generate the transmission text given the code of the message
// and the parameters
// Set ttext = true to generate the spoken transmission text,
// or false to generate the abridged menu entry text.
string gen_text(const atc_type &station, const TransCode code,
const TransPar &tpars, const bool ttext);
};
void mkATCMenuInit (void);
void mkATCMenu (void);
extern FGTransmissionList *current_transmissionlist;
#endif // _FG_TRANSMISSIONLIST_HXX