fly/flightgear
1
0
Fork 0
Code Activity
flightgear/src/ATC/trafficcontrol.cxx

848 lines
28 KiB
C++
Raw Normal View History

Better support for multiple startup messages.
2008-11-16 13:43:44 +00:00
// trafficrecord.cxx - Implementation of AIModels ATC code.
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
//
// Written by Durk Talsma, started September 2006.
//
// Copyright (C) 2006 Durk Talsma.
//
// 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
#include "trafficcontrol.hxx"
#include <AIModel/AIAircraft.hxx>
#include <AIModel/AIFlightPlan.hxx>
#include <Traffic/TrafficMgr.hxx>
James Turner: Improved runway management code: - Runways are now part of an airport, instead of a separate list - Runways are no longer represented as a boring struct, but as a class of their own. -Improved runway access to unify various runway access methods.
2008-08-14 18:13:39 +00:00
#include <Airports/groundnetwork.hxx>
#include <Airports/dynamics.hxx>
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
/***************************************************************************
* FGTrafficRecord
**************************************************************************/
FGTrafficRecord::FGTrafficRecord() :
id(0), waitsForId(0),
currentPos(0),
leg(0),
state(0),
latitude(0),
longitude(0),
heading(0),
speed(0),
altitude(0),
radius(0) {
}
void FGTrafficRecord::setPositionAndIntentions(int pos, FGAIFlightPlan *route)
{
currentPos = pos;
if (intentions.size()) {
intVecIterator i = intentions.begin();
if ((*i) != pos) {
SG_LOG(SG_GENERAL, SG_ALERT, "Error in FGTrafficRecord::setPositionAndIntentions");
//cerr << "Pos : " << pos << " Curr " << *(intentions.begin()) << endl;
for (intVecIterator i = intentions.begin(); i != intentions.end() ; i++) {
//cerr << (*i) << " ";
}
//cerr << endl;
}
intentions.erase(i);
} else {
//int legNr, routeNr;
//FGAIFlightPlan::waypoint* const wpt= route->getCurrentWaypoint();
int size = route->getNrOfWayPoints();
//cerr << "Setting pos" << pos << " ";
//cerr << "setting intentions ";
for (int i = 0; i < size; i++) {
int val = route->getRouteIndex(i);
//cerr << val<< " ";
if ((val) && (val != pos))
{
intentions.push_back(val);
//cerr << "[set] ";
}
}
//cerr << endl;
//while (route->next(&legNr, &routeNr)) {
//intentions.push_back(routeNr);
//}
//route->rewind(currentPos);
}
//exit(1);
}
bool FGTrafficRecord::checkPositionAndIntentions(FGTrafficRecord &other)
{
bool result = false;
//cerr << "Start check 1" << endl;
if (currentPos == other.currentPos)
{
//cerr << callsign << ": Check Position and intentions: we are on the same taxiway" << other.callsign << "Index = " << currentPos << endl;
result = true;
}
// else if (other.intentions.size())
// {
// cerr << "Start check 2" << endl;
// intVecIterator i = other.intentions.begin();
// while (!((i == other.intentions.end()) || ((*i) == currentPos)))
// i++;
// if (i != other.intentions.end()) {
// cerr << "Check Position and intentions: current matches other.intentions" << endl;
// result = true;
// }
else if (intentions.size()) {
//cerr << "Start check 3" << endl;
intVecIterator i = intentions.begin();
//while (!((i == intentions.end()) || ((*i) == other.currentPos)))
while (i != intentions.end()) {
if ((*i) == other.currentPos) {
break;
}
i++;
}
if (i != intentions.end()) {
//cerr << callsign << ": Check Position and intentions: .other.current matches" << other.callsign << "Index = " << (*i) << endl;
result = true;
}
}
//cerr << "Done !!" << endl;
return result;
}
void FGTrafficRecord::setPositionAndHeading(double lat, double lon, double hdg,
double spd, double alt)
{
latitude = lat;
longitude = lon;
heading = hdg;
speed = spd;
altitude = alt;
}
int FGTrafficRecord::crosses(FGGroundNetwork *net, FGTrafficRecord &other)
{
if (checkPositionAndIntentions(other) || (other.checkPositionAndIntentions(*this)))
return -1;
intVecIterator i, j;
int currentTargetNode = 0, otherTargetNode = 0;
if (currentPos > 0)
currentTargetNode = net->findSegment(currentPos )->getEnd()->getIndex(); // OKAY,...
if (other.currentPos > 0)
otherTargetNode = net->findSegment(other.currentPos)->getEnd()->getIndex(); // OKAY,...
if ((currentTargetNode == otherTargetNode) && currentTargetNode > 0)
return currentTargetNode;
if (intentions.size())
{
for (i = intentions.begin(); i != intentions.end(); i++)
{
if ((*i) > 0) {
if ((currentTargetNode == net->findSegment(*i)->getEnd()->getIndex()))
{
//cerr << "Current crosses at " << currentTargetNode <<endl;
return currentTargetNode;
}
}
}
}
if (other.intentions.size())
{
for (i = other.intentions.begin(); i != other.intentions.end(); i++)
{
if ((*i) > 0) {
if (otherTargetNode == net->findSegment(*i)->getEnd()->getIndex())
{
//cerr << "Other crosses at " << currentTargetNode <<endl;
return otherTargetNode;
}
}
}
}
if (intentions.size() && other.intentions.size())
{
for (i = intentions.begin(); i != intentions.end(); i++)
{
for (j = other.intentions.begin(); j != other.intentions.end(); j++)
{
//cerr << "finding segment " << *i << " and " << *j << endl;
if (((*i) > 0) && ((*j) > 0)) {
currentTargetNode = net->findSegment(*i)->getEnd()->getIndex();
otherTargetNode = net->findSegment(*j)->getEnd()->getIndex();
if (currentTargetNode == otherTargetNode)
{
//cerr << "Routes will cross at " << currentTargetNode << endl;
return currentTargetNode;
}
}
}
}
}
return -1;
}
bool FGTrafficRecord::onRoute(FGGroundNetwork *net, FGTrafficRecord &other)
{
int node = -1, othernode = -1;
if (currentPos >0)
node = net->findSegment(currentPos)->getEnd()->getIndex();
if (other.currentPos > 0)
othernode = net->findSegment(other.currentPos)->getEnd()->getIndex();
if ((node == othernode) && (node != -1))
return true;
if (other.intentions.size())
{
for (intVecIterator i = other.intentions.begin(); i != other.intentions.end(); i++)
{
if (*i > 0)
{
othernode = net->findSegment(*i)->getEnd()->getIndex();
if ((node == othernode) && (node > -1))
return true;
}
}
}
//if (other.currentPos > 0)
// othernode = net->findSegment(other.currentPos)->getEnd()->getIndex();
//if (intentions.size())
// {
// for (intVecIterator i = intentions.begin(); i != intentions.end(); i++)
// {
// if (*i > 0)
// {
// node = net->findSegment(*i)->getEnd()->getIndex();
// if ((node == othernode) && (node > -1))
// return true;
// }
// }
// }
return false;
}
bool FGTrafficRecord::isOpposing (FGGroundNetwork *net, FGTrafficRecord &other, int node)
{
// Check if current segment is the reverse segment for the other aircraft
FGTaxiSegment *opp;
//cerr << "Current segment " << currentPos << endl;
if ((currentPos > 0) && (other.currentPos > 0))
{
opp = net->findSegment(currentPos)->opposite();
if (opp) {
if (opp->getIndex() == other.currentPos)
return true;
}
for (intVecIterator i = intentions.begin(); i != intentions.end(); i++)
{
if (opp = net->findSegment(other.currentPos)->opposite())
{
if ((*i) > 0)
if (opp->getIndex() == net->findSegment(*i)->getIndex())
{
if (net->findSegment(*i)->getStart()->getIndex() == node) {
{
//cerr << "Found the node " << node << endl;
return true;
}
}
}
}
if (other.intentions.size())
{
for (intVecIterator j = other.intentions.begin(); j != other.intentions.end(); j++)
{
// cerr << "Current segment 1 " << (*i) << endl;
if ((*i) > 0) {
if (opp = net->findSegment(*i)->opposite())
{
if (opp->getIndex() ==
net->findSegment(*j)->getIndex())
{
//cerr << "Nodes " << net->findSegment(*i)->getIndex()
// << " and " << net->findSegment(*j)->getIndex()
// << " are opposites " << endl;
if (net->findSegment(*i)->getStart()->getIndex() == node) {
{
//cerr << "Found the node " << node << endl;
return true;
}
}
}
}
}
}
}
}
}
return false;
}
void FGTrafficRecord::setSpeedAdjustment(double spd)
{
instruction.setChangeSpeed(true);
instruction.setSpeed(spd);
}
void FGTrafficRecord::setHeadingAdjustment(double heading)
{
instruction.setChangeHeading(true);
instruction.setHeading(heading);
}
/***************************************************************************
* FGATCInstruction
*
**************************************************************************/
FGATCInstruction::FGATCInstruction()
{
holdPattern = false;
holdPosition = false;
changeSpeed = false;
changeHeading = false;
changeAltitude = false;
resolveCircularWait = false;
double speed = 0;
double heading = 0;
double alt = 0;
}
bool FGATCInstruction::hasInstruction()
{
return (holdPattern || holdPosition || changeSpeed || changeHeading || changeAltitude || resolveCircularWait);
}
string FGATCController::getGateName(FGAIAircraft *ref)
{
return ref->atGate();
}
void FGATCController::transmit(FGTrafficRecord *rec, AtcMsgId msgId, AtcMsgDir msgDir)
{
string sender, receiver;
Enable Radio #2.
2008-07-27 09:59:52 +00:00
int stationFreq = 0;
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
int taxiFreq = 0;
string atisInformation;
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
//double commFreqD;
switch (msgDir) {
case ATC_AIR_TO_GROUND:
sender = rec->getAircraft()->getTrafficRef()->getCallSign();
switch (rec->getLeg()) {
case 2:
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
case 3:
Enable Radio #2.
2008-07-27 09:59:52 +00:00
stationFreq =
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getDynamics()->getGroundFrequency(rec->getLeg());
taxiFreq =
rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getDynamics()->getGroundFrequency(3);
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
receiver = rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getName() + "-Ground";
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
atisInformation = rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getDynamics()->getAtisInformation();
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
break;
case 4:
receiver = rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getName() + "-Tower";
break;
}
break;
case ATC_GROUND_TO_AIR:
receiver = rec->getAircraft()->getTrafficRef()->getCallSign();
switch (rec->getLeg()) {
case 2:
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
case 3:
Enable Radio #2.
2008-07-27 09:59:52 +00:00
stationFreq =
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getDynamics()->getGroundFrequency(rec->getLeg());
taxiFreq =
rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getDynamics()->getGroundFrequency(3);
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
sender = rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getName() + "-Ground";
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
atisInformation = rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getDynamics()->getAtisInformation();
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
break;
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
case 4:
sender = rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getName() + "-Tower";
break;
}
break;
}
string text;
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
string taxiFreqStr;
char buffer[7];
One step further toward better integration of AI and ATC systems. * Changed the runway XX. ATC message to actually report the real designated departure runway * In case of multiple active runways, select the one with a heading that is closest to the direction of the ultimate departure destination / lines up with the arrival path.
2009-02-15 15:29:56 +00:00
double heading = 0;
string activeRunway;
string fltType;
string rwyClass;
A set of additions related to allow the use of SID and STAR procedures. The current code still has some rough edges, in particular memory still needs to be deallocated where possible, and the actual use of the code needs more testing. This code has been running without noticable problems, so I think it's ready for some wider exposure. Detailed changes include: - Finetuning of the SID/STAR data concept. - Preloading of all SIDs, from one xml file. - ATC determines which SID should be used and echoes this over the com1 or com2 radio.
2009-03-08 17:14:05 +00:00
string SID;
FGAIFlightPlan *fp;
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
switch (msgId) {
case MSG_ANNOUNCE_ENGINE_START:
text = sender + ". Ready to Start up";
break;
case MSG_REQUEST_ENGINE_START:
text = receiver + ", This is " + sender + ". Position " +getGateName(rec->getAircraft()) +
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
". Information " + atisInformation + ". " +
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
rec->getAircraft()->getTrafficRef()->getFlightRules() + " to " +
rec->getAircraft()->getTrafficRef()->getArrivalAirport()->getName() + ". Request start-up";
break;
One step further toward better integration of AI and ATC systems. * Changed the runway XX. ATC message to actually report the real designated departure runway * In case of multiple active runways, select the one with a heading that is closest to the direction of the ultimate departure destination / lines up with the arrival path.
2009-02-15 15:29:56 +00:00
// Acknowledge engine startup permission
// Assign departure runway
// Assign SID, if necessery (TODO)
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
case MSG_PERMIT_ENGINE_START:
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
taxiFreqStr = formatATCFrequency3_2(taxiFreq);
One step further toward better integration of AI and ATC systems. * Changed the runway XX. ATC message to actually report the real designated departure runway * In case of multiple active runways, select the one with a heading that is closest to the direction of the ultimate departure destination / lines up with the arrival path.
2009-02-15 15:29:56 +00:00
heading = rec->getAircraft()->getTrafficRef()->getCourse();
fltType = rec->getAircraft()->getTrafficRef()->getFlightType();
rwyClass= rec->getAircraft()->GetFlightPlan()->getRunwayClassFromTrafficType(fltType);
rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getDynamics()->getActiveRunway(rwyClass, 1, activeRunway, heading);
rec->getAircraft()->GetFlightPlan()->setRunway(activeRunway);
A set of additions related to allow the use of SID and STAR procedures. The current code still has some rough edges, in particular memory still needs to be deallocated where possible, and the actual use of the code needs more testing. This code has been running without noticable problems, so I think it's ready for some wider exposure. Detailed changes include: - Finetuning of the SID/STAR data concept. - Preloading of all SIDs, from one xml file. - ATC determines which SID should be used and echoes this over the com1 or com2 radio.
2009-03-08 17:14:05 +00:00
fp = rec->getAircraft()->getTrafficRef()->getDepartureAirport()->getDynamics()->getSID(activeRunway, heading);
rec->getAircraft()->GetFlightPlan()->setSID(fp);
if (fp) {
SID = fp->getName() + " departure";
} else {
SID = "fly runway heading ";
}
One step further toward better integration of AI and ATC systems. * Changed the runway XX. ATC message to actually report the real designated departure runway * In case of multiple active runways, select the one with a heading that is closest to the direction of the ultimate departure destination / lines up with the arrival path.
2009-02-15 15:29:56 +00:00
//snprintf(buffer, 7, "%3.2f", heading);
text = receiver + ". Start-up approved. " + atisInformation + " correct, runway " + activeRunway
A set of additions related to allow the use of SID and STAR procedures. The current code still has some rough edges, in particular memory still needs to be deallocated where possible, and the actual use of the code needs more testing. This code has been running without noticable problems, so I think it's ready for some wider exposure. Detailed changes include: - Finetuning of the SID/STAR data concept. - Preloading of all SIDs, from one xml file. - ATC determines which SID should be used and echoes this over the com1 or com2 radio.
2009-03-08 17:14:05 +00:00
+ ", " + SID + ", squawk BBBB. " +
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
"For push-back and taxi clearance call " + taxiFreqStr + ". " + sender + " control.";
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
break;
case MSG_DENY_ENGINE_START:
text = receiver + ". Standby";
break;
case MSG_ACKNOWLEDGE_ENGINE_START:
A set of additions related to allow the use of SID and STAR procedures. The current code still has some rough edges, in particular memory still needs to be deallocated where possible, and the actual use of the code needs more testing. This code has been running without noticable problems, so I think it's ready for some wider exposure. Detailed changes include: - Finetuning of the SID/STAR data concept. - Preloading of all SIDs, from one xml file. - ATC determines which SID should be used and echoes this over the com1 or com2 radio.
2009-03-08 17:14:05 +00:00
fp = rec->getAircraft()->GetFlightPlan()->getSID();
if (fp) {
SID = rec->getAircraft()->GetFlightPlan()->getSID()->getName() + " departure";
} else {
SID = "fly runway heading ";
}
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
taxiFreqStr = formatATCFrequency3_2(taxiFreq);
One step further toward better integration of AI and ATC systems. * Changed the runway XX. ATC message to actually report the real designated departure runway * In case of multiple active runways, select the one with a heading that is closest to the direction of the ultimate departure destination / lines up with the arrival path.
2009-02-15 15:29:56 +00:00
activeRunway = rec->getAircraft()->GetFlightPlan()->getRunway();
text = receiver + ". Start-up approved. " + atisInformation + " correct, runway " +
A set of additions related to allow the use of SID and STAR procedures. The current code still has some rough edges, in particular memory still needs to be deallocated where possible, and the actual use of the code needs more testing. This code has been running without noticable problems, so I think it's ready for some wider exposure. Detailed changes include: - Finetuning of the SID/STAR data concept. - Preloading of all SIDs, from one xml file. - ATC determines which SID should be used and echoes this over the com1 or com2 radio.
2009-03-08 17:14:05 +00:00
activeRunway + ", " + SID + ", squawk BBBB. " +
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
"For push-back and taxi clearance call " + taxiFreqStr + ". " + sender;
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
break;
default:
break;
}
Enable Radio #2.
2008-07-27 09:59:52 +00:00
double onBoardRadioFreq0 = fgGetDouble("/instrumentation/comm[0]/frequencies/selected-mhz");
double onBoardRadioFreq1 = fgGetDouble("/instrumentation/comm[1]/frequencies/selected-mhz");
int onBoardRadioFreqI0 = (int) floor(onBoardRadioFreq0 * 100 + 0.5);
int onBoardRadioFreqI1 = (int) floor(onBoardRadioFreq1 * 100 + 0.5);
Better support for multiple startup messages.
2008-11-16 13:43:44 +00:00
//cerr << "Using " << onBoardRadioFreq0 << ", " << onBoardRadioFreq1 << " and " << stationFreq << endl;
Enable Radio #2.
2008-07-27 09:59:52 +00:00
// Display ATC message only when one of the radios is tuned
// the relevant frequency.
// Note that distance attenuation is currently not yet implemented
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
//cerr << "Transmitting " << text << " at " << stationFreq;
Enable Radio #2.
2008-07-27 09:59:52 +00:00
if ((onBoardRadioFreqI0 == stationFreq) || (onBoardRadioFreqI1 == stationFreq)) {
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
fgSetString("/sim/messages/atc", text.c_str());
//cerr << "Printing Message: " << endl;
}
}
Some further work toward adding more AI/ATC messages. This patch provides some prepratory work for assigning different operations to different frequencies. It also returns a stub for returning an ATIS message ID. Currently, the ATIC information ID is hardcoded to "Sierra", which needs to be replaced by a dynamic ID once ATIS services are fully integrated with the new trafficcontrol code. At least, it's marginally more realistic then the previous information XX. :-).
2009-02-07 17:17:07 +00:00
string FGATCController::formatATCFrequency3_2(int freq) {
char buffer[7];
snprintf(buffer, 7, "%3.2f", ( (float) freq / 100.0) );
return string(buffer);
}
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
/***************************************************************************
* class FGTowerController
*
**************************************************************************/
FGTowerController::FGTowerController() :
FGATCController()
{
}
//
void FGTowerController::announcePosition(int id, FGAIFlightPlan *intendedRoute, int currentPosition,
double lat, double lon, double heading,
double speed, double alt, double radius, int leg,
FGAIAircraft *ref)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search whether the current id alread has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
if (activeTraffic.size()) {
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
// Add a new TrafficRecord if no one exsists for this aircraft.
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
FGTrafficRecord rec;
rec.setId(id);
rec.setPositionAndHeading(lat, lon, heading, speed, alt);
rec.setRunway(intendedRoute->getRunway());
rec.setLeg(leg);
//rec.setCallSign(callsign);
rec.setAircraft(ref);
activeTraffic.push_back(rec);
} else {
i->setPositionAndHeading(lat, lon, heading, speed, alt);
}
}
void FGTowerController::update(int id, double lat, double lon, double heading, double speed, double alt,
double dt)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search search if the current id has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
TrafficVectorIterator current, closest;
if (activeTraffic.size()) {
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
// // update position of the current aircraft
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: updating aircraft without traffic record");
} else {
i->setPositionAndHeading(lat, lon, heading, speed, alt);
current = i;
}
setDt(getDt() + dt);
// // see if we already have a clearance record for the currently active runway
ActiveRunwayVecIterator rwy = activeRunways.begin();
// again, a map might be more efficient here
if (activeRunways.size()) {
//while ((rwy->getRunwayName() != current->getRunway()) && (rwy != activeRunways.end())) {
while (rwy != activeRunways.end()) {
if (rwy->getRunwayName() == current->getRunway()) {
break;
}
rwy++;
}
}
if (rwy == activeRunways.end()) {
ActiveRunway aRwy(current->getRunway(), id);
activeRunways.push_back(aRwy); // Since there are no clearance records for this runway yet
current->setHoldPosition(false); // Clear the current aircraft to continue
}
else {
// Okay, we have a clearance record for this runway, so check
// whether the clearence ID matches that of the current aircraft
if (id == rwy->getCleared()) {
current->setHoldPosition(false);
} else {
current->setHoldPosition(true);
}
}
}
void FGTowerController::signOff(int id)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search search if the current id alread has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
if (activeTraffic.size()) {
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
// If this aircraft has left the runway, we can clear the departure record for this runway
ActiveRunwayVecIterator rwy = activeRunways.begin();
if (activeRunways.size()) {
//while ((rwy->getRunwayName() != i->getRunway()) && (rwy != activeRunways.end())) {
while (rwy != activeRunways.end()) {
if (rwy->getRunwayName() == i->getRunway()) {
break;
}
rwy++;
}
if (rwy != activeRunways.end()) {
rwy = activeRunways.erase(rwy);
} else {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: Attempting to erase non-existing runway clearance record in FGTowerController::signoff");
}
}
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: Aircraft without traffic record is signing off from tower");
} else {
i = activeTraffic.erase(i);
}
}
// NOTE:
// IF WE MAKE TRAFFICRECORD A MEMBER OF THE BASE CLASS
// THE FOLLOWING THREE FUNCTIONS: SIGNOFF, HAS INSTRUCTION AND GETINSTRUCTION CAN
// BECOME DEVIRTUALIZED AND BE A MEMBER OF THE BASE ATCCONTROLLER CLASS
// WHICH WOULD SIMPLIFY CODE MAINTENANCE.
// Note that this function is probably obsolete
bool FGTowerController::hasInstruction(int id)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search search if the current id has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
if (activeTraffic.size())
{
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: checking ATC instruction for aircraft without traffic record");
} else {
return i->hasInstruction();
}
return false;
}
FGATCInstruction FGTowerController::getInstruction(int id)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search search if the current id has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
if (activeTraffic.size()) {
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: requesting ATC instruction for aircraft without traffic record");
} else {
return i->getInstruction();
}
return FGATCInstruction();
}
/***************************************************************************
* class FGStartupController
*
**************************************************************************/
FGStartupController::FGStartupController() :
FGATCController()
{
Better support for multiple startup messages.
2008-11-16 13:43:44 +00:00
available = false;
lastTransmission = 0;
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
}
void FGStartupController::announcePosition(int id, FGAIFlightPlan *intendedRoute, int currentPosition,
double lat, double lon, double heading,
double speed, double alt, double radius, int leg,
FGAIAircraft *ref)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search whether the current id alread has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
if (activeTraffic.size()) {
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
// Add a new TrafficRecord if no one exsists for this aircraft.
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
FGTrafficRecord rec;
rec.setId(id);
rec.setPositionAndHeading(lat, lon, heading, speed, alt);
rec.setRunway(intendedRoute->getRunway());
rec.setLeg(leg);
//rec.setCallSign(callsign);
rec.setAircraft(ref);
rec.setHoldPosition(true);
activeTraffic.push_back(rec);
} else {
i->setPositionAndHeading(lat, lon, heading, speed, alt);
}
}
// NOTE:
// IF WE MAKE TRAFFICRECORD A MEMBER OF THE BASE CLASS
// THE FOLLOWING THREE FUNCTIONS: SIGNOFF, HAS INSTRUCTION AND GETINSTRUCTION CAN
// BECOME DEVIRTUALIZED AND BE A MEMBER OF THE BASE ATCCONTROLLER CLASS
// WHICH WOULD SIMPLIFY CODE MAINTENANCE.
// Note that this function is probably obsolete
bool FGStartupController::hasInstruction(int id)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search search if the current id has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
if (activeTraffic.size())
{
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: checking ATC instruction for aircraft without traffic record");
} else {
return i->hasInstruction();
}
return false;
}
FGATCInstruction FGStartupController::getInstruction(int id)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search search if the current id has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
if (activeTraffic.size()) {
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: requesting ATC instruction for aircraft without traffic record");
} else {
return i->getInstruction();
}
return FGATCInstruction();
}
void FGStartupController::signOff(int id)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search search if the current id alread has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
if (activeTraffic.size()) {
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: Aircraft without traffic record is signing off from tower");
} else {
i = activeTraffic.erase(i);
}
}
void FGStartupController::update(int id, double lat, double lon, double heading, double speed, double alt,
double dt)
{
TrafficVectorIterator i = activeTraffic.begin();
// Search search if the current id has an entry
// This might be faster using a map instead of a vector, but let's start by taking a safe route
TrafficVectorIterator current, closest;
if (activeTraffic.size()) {
//while ((i->getId() != id) && i != activeTraffic.end()) {
while (i != activeTraffic.end()) {
if (i->getId() == id) {
break;
}
i++;
}
}
// // update position of the current aircraft
if (i == activeTraffic.end() || (activeTraffic.size() == 0)) {
SG_LOG(SG_GENERAL, SG_ALERT, "AI error: updating aircraft without traffic record");
} else {
i->setPositionAndHeading(lat, lon, heading, speed, alt);
current = i;
}
setDt(getDt() + dt);
int state = i->getState();
time_t startTime = i->getAircraft()->getTrafficRef()->getDepartureTime();
time_t now = time(NULL) + fgGetLong("/sim/time/warp");
Better support for multiple startup messages.
2008-11-16 13:43:44 +00:00
//cerr << i->getAircraft()->getTrafficRef()->getCallSign()
// << " is scheduled to depart in " << startTime-now << " seconds. Available = " << available
// << " at parking " << getGateName(i->getAircraft()) << endl;
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
if ((now - lastTransmission) > 3 + (rand() % 15)) {
available = true;
}
if ((state == 0) && available) {
if (now > startTime) {
Better support for multiple startup messages.
2008-11-16 13:43:44 +00:00
//cerr << "Transmitting startup msg" << endl;
Initial attempt to establish a better integration between AI and ATC code. Various other patches that have been lingering around for a while: * Moved trafficcontrol.[ch]xx from the Airports directory to ATC, where it really belongs. * AI aircraft will request startup clearance, and ground control will approve. * Starting AI Aircraft will be pushed back to a predefined holding point on the ground network, and wait a while before taxiing out to the runway
2008-07-13 12:51:06 +00:00
transmit(&(*i), MSG_ANNOUNCE_ENGINE_START, ATC_AIR_TO_GROUND);
i->updateState();
lastTransmission = now;
available = false;
}
}
if ((state == 1) && available) {
if (now > startTime+60) {
transmit(&(*i), MSG_REQUEST_ENGINE_START, ATC_AIR_TO_GROUND);
i->updateState();
lastTransmission = now;
available = false;
}
}
if ((state == 2) && available) {
if (now > startTime+80) {
transmit(&(*i), MSG_PERMIT_ENGINE_START, ATC_GROUND_TO_AIR);
i->updateState();
lastTransmission = now;
available = false;
}
}
if ((state == 3) && available){
if (now > startTime+100) {
transmit(&(*i), MSG_ACKNOWLEDGE_ENGINE_START, ATC_AIR_TO_GROUND);
i->updateState();
lastTransmission = now;
available = false;
}
}
// TODO: Switch to APRON control and request pushback Clearance.
// Get Push back clearance
if ((state == 4) && available){
i->setHoldPosition(false);
}
}
Copy permalink