src/Include/config.h-msvc8 \
src/Aircraft/Makefile \
src/Airports/Makefile \
- src/ATC/Makefile \
+ src/ATCDCL/Makefile \
src/Autopilot/Makefile \
src/Cockpit/Makefile \
src/Cockpit/built_in/Makefile \
+++ /dev/null
-// FGAIEntity - abstract base class an artificial intelligence entity
-//
-// Written 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.
-
-/*****************************************************************
-*
-* WARNING - Curt has some ideas about AI traffic so anything in here
-* may get rewritten or scrapped. Contact Curt http://www.flightgear.org/~curt
-* before spending any time or effort on this code!!!
-*
-******************************************************************/
-
-#ifdef HAVE_CONFIG_H
-# include <config.h>
-#endif
-
-#include <Main/globals.hxx>
-#include <Scenery/scenery.hxx>
-#include <simgear/constants.h>
-#include <simgear/math/point3d.hxx>
-#include <simgear/math/sg_geodesy.hxx>
-#include <simgear/misc/sg_path.hxx>
-#include <string>
-
-#include "AIEntity.hxx"
-
-FGAIEntity::FGAIEntity() {
-}
-
-FGAIEntity::~FGAIEntity() {
- //cout << "FGAIEntity dtor called..." << endl;
- //cout << "Removing model from scene graph..." << endl;
- globals->get_scenery()->get_scene_graph()->removeChild(_aip.getSceneGraph());
-
- //cout << "Done!" << endl;
-}
-
-void FGAIEntity::SetModel(osg::Node* model) {
- _model = model;
- _aip.init(_model.get());
- _aip.setVisible(false);
- globals->get_scenery()->get_scene_graph()->addChild(_aip.getSceneGraph());
-
-}
-
-void FGAIEntity::Update(double dt) {
-}
-
-const string &FGAIEntity::GetCallsign() {
- static string s = "";
- return(s);
-}
-
-void FGAIEntity::RegisterTransmission(int code) {
-}
-
-// Run the internal calculations
-//void FGAIEntity::Update() {
-void FGAIEntity::Transform() {
- _aip.setPosition(_pos.lon(), _pos.lat(), _pos.elev() * SG_METER_TO_FEET);
- _aip.setOrientation(_roll, _pitch, _hdg);
- _aip.update();
-}
+++ /dev/null
-// FGAIEntity - abstract base class an artificial intelligence entity
-//
-// Written 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.
-
-#ifndef _FG_AIEntity_HXX
-#define _FG_AIEntity_HXX
-
-#include <simgear/math/point3d.hxx>
-#include <simgear/scene/model/placement.hxx>
-
-
-/*****************************************************************
-*
-* FGAIEntity - this class implements the minimum requirement
-* for any AI entity - a position, an orientation, an associated
-* 3D model, and the ability to be moved. It does nothing useful
-* and all AI entities are expected to be derived from it.
-*
-******************************************************************/
-class FGAIEntity {
-
-public:
-
- FGAIEntity();
- virtual ~FGAIEntity();
-
- // Set the 3D model to use (Must be called)
- void SetModel(osg::Node* model);
-
- // Run the internal calculations
- virtual void Update(double dt)=0;
-
- // Send a transmission *TO* the AIEntity.
- // FIXME int code is a hack - eventually this will receive Alexander's coded messages.
- virtual void RegisterTransmission(int code)=0;
-
- inline const Point3D& GetPos() const { return(_pos); }
-
- virtual const string& GetCallsign()=0;
-
-protected:
-
- Point3D _pos; // WGS84 lat & lon in degrees, elev above sea-level in meters
- double _hdg; //True heading in degrees
- double _roll; //degrees
- double _pitch; //degrees
-
- char* _model_path; //Path to the 3D model
- osg::ref_ptr<osg::Node> _model; // Pointer to the model
- SGModelPlacement _aip;
-
- void Transform();
-};
-
-#endif // _FG_AIEntity_HXX
-
+++ /dev/null
-// FGAILocalTraffic - AIEntity derived class with enough logic to
-// fly and interact with the traffic pattern.
-//
-// Written 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 <Airports/runways.hxx>
-#include <Main/globals.hxx>
-#include <simgear/math/point3d.hxx>
-#include <string>
-#include <math.h>
-
-SG_USING_STD(string);
-
-#include "ATC.hxx"
-#include "ATCmgr.hxx"
-#include "AILocalTraffic.hxx"
-#include "AIGAVFRTraffic.hxx"
-#include "ATCutils.hxx"
-#include "tower.hxx"
-
-FGAIGAVFRTraffic::FGAIGAVFRTraffic() {
- ATC = globals->get_ATC_mgr();
- _towerContactedIncoming = false;
- _clearedStraightIn = false;
- _clearedDownwindEntry = false;
- _incoming = false;
- _straightIn = false;
- _downwindEntry = false;
- _climbout = false;
- _local = false;
- _established = false;
- _e45 = false;
- _entering = false;
- _turning = false;
- _cruise_climb_ias = 90.0;
- _cruise_ias = 110.0;
- patternDirection = -1.0;
-
- // TESTING - REMOVE OR COMMENT OUT BEFORE COMMIT!!!
- //_towerContactPrinted = false;
-}
-
-FGAIGAVFRTraffic::~FGAIGAVFRTraffic() {
-}
-
-// We should never need to Init FGAIGAVFRTraffic in the pattern since that implies arrivel
-// and we can just use an FGAILocalTraffic instance for that instead.
-
-// Init en-route to destID at point pt.
-// TODO - no idea what to do if pt is above planes ceiling due mountains!!
-bool FGAIGAVFRTraffic::Init(const Point3D& pt, const string& destID, const string& callsign) {
- FGAILocalTraffic::Init(callsign, destID, EN_ROUTE);
- // TODO FIXME - to get up and running we're going to ignore elev and get FGAIMgr to
- // pass in known good values for the test location. Need to fix this!!! (or at least canonically decide who has responsibility for setting elev).
- _enroute = true;
- _destID = destID;
- _pos = pt;
- _destPos = fgGetAirportPos(destID); // TODO - check if we are within the tower catchment area already.
- _cruise_alt = (_destPos.elev() + 2500.0) * SG_FEET_TO_METER; // TODO look at terrain elevation as well
- _pos.setelev(_cruise_alt);
- // initially set waypoint as airport location
- _wp = _destPos;
- // Set the initial track
- track = GetHeadingFromTo(_pos, _wp);
- // And set the plane to keep following it.
- SetTrack(GetHeadingFromTo(_pos, _wp));
- _roll = 0.0;
- _pitch = 0.0;
- slope = 0.0;
- // TODO - set climbout if altitude is below normal cruising altitude?
- //Transform();
- // Assume it's OK to set the plane visible
- _aip.setVisible(true);
- //cout << "Setting visible true\n";
- Transform();
- return(true);
-}
-
-// Init at srcID to fly to destID
-bool FGAIGAVFRTraffic::Init(const string& srcID, const string& destID, const string& callsign, OperatingState state) {
- _enroute = false;
- FGAILocalTraffic::Init(callsign, srcID, PARKED);
- return(true);
-}
-
-void FGAIGAVFRTraffic::Update(double dt) {
- if(_enroute) {
- //cout << "_enroute\n";
- //cout << "e" << flush;
- FlyPlane(dt);
- //cout << "f" << flush;
- Transform();
- //cout << "g" << flush;
- FGAIPlane::Update(dt);
- //cout << "h" << flush;
- responseCounter += dt;
-
- // we shouldn't really need this since there's a LOD of 10K on the whole plane anyway I think.
- // There are two _aip.setVisible statements set when _local = true that can be removed if the below is removed.
- if(dclGetHorizontalSeparation(_pos, Point3D(fgGetDouble("/position/longitude-deg"), fgGetDouble("/position/latitude-deg"), 0.0)) > 8000) _aip.setVisible(false);
- else _aip.setVisible(true);
-
- } else if(_local) {
- //cout << "L";
- //cout << "_local\n";
- FGAILocalTraffic::Update(dt);
- }
-}
-
-void FGAIGAVFRTraffic::FlyPlane(double dt) {
- if(_climbout) {
- // Check whether to level off
- if(_pos.elev() >= _cruise_alt) {
- slope = 0.0;
- _pitch = 0.0;
- IAS = _cruise_ias; // FIXME - use smooth transistion to new speed and attitude.
- _climbout = false;
- } else {
- slope = 4.0;
- _pitch = 5.0;
- IAS = _cruise_climb_ias;
- }
- } else {
- // TESTING
- /*
- if(dclGetHorizontalSeparation(_destPos, _pos) / 1600.0 < 8.1) {
- if(!_towerContactPrinted) {
- if(airportID == "KSQL") {
- cout << "****************************************************************\n";
- cout << "++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++\n";
- cout << "****************************************************************\n";
- }
- _towerContactPrinted = true;
- }
- }
- */
-
- // if distance to destination is less than 6 - 9 miles contact tower
- // and prepare to become _incoming after response.
- // Possibly check whether to start descent before this?
- //cout << "." << flush;
- //cout << "sep = " << dclGetHorizontalSeparation(_destPos, _pos) / 1600.0 << '\n';
- if(dclGetHorizontalSeparation(_destPos, _pos) / 1600.0 < 8.0) {
- //cout << "-" << flush;
- if(!_towerContactedIncoming) {
- //cout << "_" << flush;
- GetAirportDetails(airportID);
- //cout << "L" << flush;
- if(_controlled) {
- freq = (double)tower->get_freq() / 100.0;
- tuned_station = tower;
- } else {
- freq = 122.8; // TODO - need to get the correct CTAF/Unicom frequency if no tower
- tuned_station = NULL;
- }
- //cout << "freq = " << freq << endl;
- GetRwyDetails(airportID);
- //"@AP Tower @CS @MI miles @CD of the airport for full stop with ATIS"
- // At the bare minimum we ought to make sure it goes the right way at dual parallel rwy airports!
- if(rwy.rwyID.size() == 3) {
- patternDirection = (rwy.rwyID.substr(2,1) == "R" ? 1 : -1);
- }
- if(_controlled) {
- pending_transmission = tower->get_name();
- pending_transmission += " Tower ";
- } else {
- pending_transmission = "Traffic ";
- // TODO - find some way of getting uncontrolled airport name
- }
- pending_transmission += plane.callsign;
- //char buf[10];
- int dist_miles = (int)dclGetHorizontalSeparation(_pos, _destPos) / 1600;
- //sprintf(buf, " %i ", dist_miles);
- pending_transmission += " ";
- pending_transmission += ConvertNumToSpokenDigits(dist_miles);
- if(dist_miles > 1) pending_transmission += " miles ";
- else pending_transmission += " mile ";
- pending_transmission += GetCompassDirection(GetHeadingFromTo(_destPos, _pos));
- pending_transmission += " of the airport for full stop with ATIS";
- //cout << pending_transmission << endl;
- Transmit(14); // 14 is the callback code, NOT the timeout!
- responseCounter = 0;
- _towerContactedIncoming = true;
- } else {
- //cout << "?" << flush;
- if(_clearedStraightIn && responseCounter > 5.5) {
- //cout << "5 " << flush;
- _clearedStraightIn = false;
- _straightIn = true;
- _incoming = true;
- _wp = GetPatternApproachPos();
- //_hdg = GetHeadingFromTo(_pos, _wp); // TODO - turn properly!
- SetTrack(GetHeadingFromTo(_pos, _wp));
- slope = atan((_wp.elev() - _pos.elev()) / dclGetHorizontalSeparation(_wp, _pos)) * DCL_RADIANS_TO_DEGREES;
- double thesh_offset = 0.0;
- Point3D opos = ortho.ConvertToLocal(_pos);
- double angToApt = atan((_pos.elev() - fgGetAirportElev(airportID)) / (opos.y() - thesh_offset)) * DCL_RADIANS_TO_DEGREES;
- //cout << "angToApt = " << angToApt << ' ';
- slope = (angToApt > -5.0 ? 0.0 : angToApt);
- //cout << "slope = " << slope << '\n';
- pending_transmission = "Straight-in ";
- pending_transmission += ConvertRwyNumToSpokenString(rwy.rwyID);
- pending_transmission += " ";
- pending_transmission += plane.callsign;
- //cout << pending_transmission << '\n';
- ConditionalTransmit(4);
- } else if(_clearedDownwindEntry && responseCounter > 5.5) {
- //cout << "6" << flush;
- _clearedDownwindEntry = false;
- _downwindEntry = true;
- _incoming = true;
- _wp = GetPatternApproachPos();
- SetTrack(GetHeadingFromTo(_pos, _wp));
- slope = atan((_wp.elev() - _pos.elev()) / dclGetHorizontalSeparation(_wp, _pos)) * DCL_RADIANS_TO_DEGREES;
- //cout << "slope = " << slope << '\n';
- pending_transmission = "Report ";
- pending_transmission += (patternDirection == 1 ? "right downwind " : "left downwind ");
- pending_transmission += ConvertRwyNumToSpokenString(rwy.rwyID);
- pending_transmission += " ";
- pending_transmission += plane.callsign;
- //cout << pending_transmission << '\n';
- ConditionalTransmit(4);
- }
- }
- if(_pos.elev() < (fgGetAirportElev(airportID) + (1000.0 * SG_FEET_TO_METER))) slope = 0.0;
- }
- }
- if(_incoming) {
- //cout << "i" << '\n';
- Point3D orthopos = ortho.ConvertToLocal(_pos);
- // TODO - Check whether to start descent
- // become _local after the 3 mile report.
- if(_pos.elev() < (fgGetAirportElev(airportID) + (1000.0 * SG_FEET_TO_METER))) slope = 0.0;
- // TODO - work out why I needed to add the above line to stop the plane going underground!!!
- // (Although it's worth leaving it in as a robustness check anyway).
- if(_straightIn) {
- //cout << "A " << flush;
- if(fabs(orthopos.x()) < 10.0 && !_established) {
- SetTrack(rwy.hdg);
- _established = true;
- //cout << "Established at " << orthopos << '\n';
- }
- double thesh_offset = 30.0;
- //cout << "orthopos.y = " << orthopos.y() << " alt = " << _pos.elev() - fgGetAirportElev(airportID) << '\n';
- if(_established && (orthopos.y() > -5400.0)) {
- slope = atan((_pos.elev() - fgGetAirportElev(airportID)) / (orthopos.y() - thesh_offset)) * DCL_RADIANS_TO_DEGREES;
- //cout << "slope0 = " << slope << '\n';
- }
- //cout << "slope1 = " << slope << '\n';
- if(slope > -5.5) slope = 0.0; // ie we're too low.
- //cout << "slope2 = " << slope << '\n';
- slope += 0.001; // To avoid yo-yoing with the above.
- //if(_established && (orthopos.y() > -5400.0)) slope = -5.5;
- if(_established && (orthopos.y() > -4800.0)) {
- pending_transmission = "3 mile final Runway ";
- pending_transmission += ConvertRwyNumToSpokenString(rwy.rwyID);
- pending_transmission += " ";
- pending_transmission += plane.callsign;
- //cout << pending_transmission << '\n';
- ConditionalTransmit(35);
- _local = true;
- _aip.setVisible(true); // HACK
- _enroute = false;
- StraightInEntry(true);
- }
- } else if(_downwindEntry) {
- //cout << "B" << flush;
- if(_entering) {
- //cout << "C" << flush;
- if(_turning) {
- if(fabs(_hdg - (rwy.hdg + 180)) < 2.0) { // TODO - use track instead of _hdg?
- //cout << "Going Local...\n";
- leg = DOWNWIND;
- _local = true;
- _aip.setVisible(true); // HACK
- _enroute = false;
- _entering = false;
- _turning = false;
- DownwindEntry();
- }
- }
- if(fabs(orthopos.x() - (patternDirection == 1 ? 1000 : -1000)) < (_e45 ? 175 : 550)) { // Caution - hardwired turn clearances.
- //cout << "_turning...\n";
- _turning = true;
- SetTrack(rwy.hdg + 180.0);
- } // TODO - need to check for other traffic in the pattern and enter much more integilently than that!!!
- } else {
- //cout << "D" << flush;
- //cout << '\n' << dclGetHorizontalSeparation(_wp, _pos) << '\n';
- //cout << ortho.ConvertToLocal(_pos);
- //cout << ortho.ConvertToLocal(_wp);
- if(dclGetHorizontalSeparation(_wp, _pos) < 100.0) {
- pending_transmission = "2 miles out for ";
- pending_transmission += (patternDirection == 1 ? "right " : "left ");
- pending_transmission += "downwind Runway ";
- pending_transmission += ConvertRwyNumToSpokenString(rwy.rwyID);
- pending_transmission += " ";
- pending_transmission += plane.callsign;
- //cout << pending_transmission << '\n';
- // TODO - are we at pattern altitude??
- slope = 0.0;
- ConditionalTransmit(30);
- if(_e45) {
- SetTrack(patternDirection == 1 ? rwy.hdg - 135.0 : rwy.hdg + 135.0);
- } else {
- SetTrack(patternDirection == 1 ? rwy.hdg + 90.0 : rwy.hdg - 90.0);
- }
- //if(_hdg < 0.0) _hdg += 360.0;
- _entering = true;
- } else {
- SetTrack(GetHeadingFromTo(_pos, _wp));
- }
- }
- }
- } else {
- // !_incoming
- slope = 0.0;
- }
- // FIXME - lots of hackery in the next six lines!!!!
- //double track = _hdg;
- double crab = 0.0; // This is a placeholder for when we take wind into account.
- _hdg = track + crab;
- double vel = _cruise_ias;
- double dist = vel * 0.514444 * dt;
- _pos = dclUpdatePosition(_pos, track, slope, dist);
-}
-
-void FGAIGAVFRTraffic::RegisterTransmission(int code) {
- switch(code) {
- case 1: // taxi request cleared
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- case 2: // contact tower
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- case 3: // Cleared to line up
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- case 4: // cleared to take-off
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- case 5: // contact ground
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- case 6: // taxi to the GA parking
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- case 7: // Cleared to land
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- case 13: // Go around!
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- case 14: // VFR approach for straight-in
- responseCounter = 0;
- _clearedStraightIn = true;
- break;
- case 15: // VFR approach for downwind entry
- responseCounter = 0;
- _clearedDownwindEntry = true;
- break;
- default:
- SG_LOG(SG_ATC, SG_WARN, "FGAIGAVFRTraffic::RegisterTransmission(...) called with unknown code " << code);
- FGAILocalTraffic::RegisterTransmission(code);
- break;
- }
-}
-
-// Callback handler
-// TODO - Really should enumerate these coded values.
-void FGAIGAVFRTraffic::ProcessCallback(int code) {
- // 1 - Request Departure from ground
- // 2 - Report at hold short
- // 10 - report crosswind
- // 11 - report downwind
- // 12 - report base
- // 13 - report final
- // 14 - Contact Tower for VFR arrival
- // 99 - Remove self
- if(code < 14) {
- FGAILocalTraffic::ProcessCallback(code);
- } else if(code == 14) {
- if(_controlled) {
- tower->VFRArrivalContact(plane, this, FULL_STOP);
- }
- // TODO else possibly announce arrival intentions at uncontrolled airport?
- } else if(code == 99) {
- // Might handle this different in future - hence separated from the other codes to pass to AILocalTraffic.
- FGAILocalTraffic::ProcessCallback(code);
- }
-}
-
-// Return an appropriate altitude to fly at based on the desired altitude and direction
-// whilst respecting the quadrangle rule.
-int FGAIGAVFRTraffic::GetQuadrangleAltitude(int dir, int des_alt) {
- return(8888);
- // TODO - implement me!
-}
-
-// Calculates the position needed to set up for either pattern entry or straight in approach.
-// Currently returns one of three positions dependent on initial position wrt threshold of active rwy.
-// 1/ A few miles out on extended centreline for straight-in.
-// 2/ At an appropriate point on circuit side of rwy for a 45deg entry to downwind.
-// 3/ At and appropriate point on non-circuit side of rwy at take-off end for perpendicular entry to circuit overflying end-of-rwy.
-Point3D FGAIGAVFRTraffic::GetPatternApproachPos() {
- //cout << "\n\n";
- //cout << "Calculating pattern approach pos for " << plane.callsign << '\n';
- Point3D orthopos = ortho.ConvertToLocal(_pos);
- Point3D tmp;
- //cout << "patternDirection = " << patternDirection << '\n';
- if(orthopos.y() >= -1000.0) { // Note that this has to be set the same as the calculation in tower.cxx - at the moment approach type is not transmitted properly between the two.
- //cout << "orthopos.x = " << orthopos.x() << '\n';
- if((orthopos.x() * patternDirection) > 0.0) { // 45 deg entry
- tmp.setx(2000 * patternDirection);
- tmp.sety((rwy.end2ortho.y() / 2.0) + 2000);
- tmp.setelev(fgGetAirportElev(airportID) + (1000 * SG_FEET_TO_METER));
- _e45 = true;
- //cout << "45 deg entry... ";
- } else {
- tmp.setx(1000 * patternDirection * -1);
- tmp.sety(rwy.end2ortho.y());
- tmp.setelev(fgGetAirportElev(airportID) + (1000 * SG_FEET_TO_METER));
- _e45 = false;
- //cout << "90 deg entry... ";
- }
- } else {
- tmp.setx(0);
- tmp.sety(-5400);
- tmp.setelev((5400.0 / 6.0) + fgGetAirportElev(airportID) + 10.0);
- //cout << "Straight in... ";
- }
- //cout << "Waypoint is " << tmp << '\n';
- //cout << ortho.ConvertFromLocal(tmp) << '\n';
- //cout << '\n';
- //exit(-1);
- return ortho.ConvertFromLocal(tmp);
-}
-
-//FGAIGAVFRTraffic::
-
-//FGAIGAVFRTraffic::
-
-//FGAIGAVFRTraffic::
+++ /dev/null
-// FGAILocalTraffic - AIEntity derived class with enough logic to
-// fly and interact with the traffic pattern.
-//
-// Written 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.
-
-#ifndef _FG_AIGAVFRTraffic_HXX
-#define _FG_AIGAVFRTraffic_HXX
-
-#include <simgear/math/point3d.hxx>
-#include <Main/fg_props.hxx>
-
-#include "AILocalTraffic.hxx"
-
-#include <string>
-SG_USING_STD(string);
-
-class FGAIGAVFRTraffic : public FGAILocalTraffic {
-
-public:
-
- FGAIGAVFRTraffic();
- ~FGAIGAVFRTraffic();
-
- // Init en-route to destID at point pt. (lat, lon, elev) (elev in meters, lat and lon in degrees).
- bool Init(const Point3D& pt, const string& destID, const string& callsign);
- // Init at srcID to fly to destID
- bool Init(const string& srcID, const string& destID, const string& callsign, OperatingState state = PARKED);
-
- // Run the internal calculations
- void Update(double dt);
-
- // Return what type of landing we're doing on this circuit
- //LandingType GetLandingOption();
-
- void RegisterTransmission(int code);
-
- // Process callbacks sent by base class
- // (These codes are not related to the codes above)
- void ProcessCallback(int code);
-
-protected:
-
- // Do what is necessary to land and parkup at home airport
- void ReturnToBase(double dt);
-
- //void GetRwyDetails(string id);
-
-
-private:
- FGATCMgr* ATC;
- // This is purely for synactic convienience to avoid writing globals->get_ATC_mgr()-> all through the code!
-
- // High-level stuff
- OperatingState operatingState;
- bool touchAndGo; //True if circuits should be flown touch and go, false for full stop
-
- // Performance characteristics of the plane in knots and ft/min - some of this might get moved out into FGAIPlane
- double best_rate_of_climb_speed;
- double best_rate_of_climb;
- double nominal_climb_speed;
- double nominal_climb_rate;
- double nominal_cruise_speed;
- double nominal_circuit_speed;
- double nominal_descent_rate;
- double nominal_approach_speed;
- double nominal_final_speed;
- double stall_speed_landing_config;
-
- // environment - some of this might get moved into FGAIPlane
- SGPropertyNode_ptr wind_from_hdg; //degrees
- SGPropertyNode_ptr wind_speed_knots; //knots
-
- atc_type changeFreqType; // the service we need to change to
-
- void CalculateSoD(double base_leg_pos, double downwind_leg_pos, bool pattern_direction);
-
- // GA VFR specific
- bool _towerContactedIncoming;
- bool _straightIn;
- bool _clearedStraightIn;
- bool _downwindEntry;
- bool _clearedDownwindEntry;
- Point3D _wp; // Next waypoint (ie. the one we're currently heading for)
- bool _enroute;
- string _destID;
- bool _climbout;
- double _cruise_alt;
- double _cruise_ias;
- double _cruise_climb_ias;
- Point3D _destPos;
- bool _local;
- bool _incoming;
- bool _established;
- bool _e45;
- bool _entering;
- bool _turning;
-
- //ssgBranch* _model;
-
- int GetQuadrangleAltitude(int dir, int des_alt);
-
- Point3D GetPatternApproachPos();
-
- void FlyPlane(double dt);
-
- // HACK for testing - remove or comment out before CVS commit!!!
- //bool _towerContactPrinted;
-};
-
-#endif // _FG_AILocalTraffic_HXX
+++ /dev/null
-// FGAILocalTraffic - AIEntity derived class with enough logic to
-// fly and interact with the traffic pattern.
-//
-// Written 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.
-
-/*==========================================================
-
-TODO list.
-
-Should get pattern direction from tower.
-
-Need to continually monitor and adjust deviation from glideslope
-during descent to avoid occasionally landing short or long.
-
-============================================================*/
-
-#ifdef HAVE_CONFIG_H
-# include <config.h>
-#endif
-
-#include <simgear/scene/model/location.hxx>
-
-#include <Airports/runways.hxx>
-#include <Main/globals.hxx>
-#include <Main/viewer.hxx>
-#include <Scenery/scenery.hxx>
-#include <Scenery/tilemgr.hxx>
-#include <simgear/math/point3d.hxx>
-#include <simgear/math/sg_geodesy.hxx>
-#include <simgear/misc/sg_path.hxx>
-#include <string>
-#include <math.h>
-
-SG_USING_STD(string);
-
-#include "ATCmgr.hxx"
-#include "AILocalTraffic.hxx"
-#include "ATCutils.hxx"
-#include "AIMgr.hxx"
-
-FGAILocalTraffic::FGAILocalTraffic() {
- /*ssgBranch *model = sgLoad3DModel( globals->get_fg_root(),
- planepath.c_str(),
- globals->get_props(),
- globals->get_sim_time_sec() );
- *//*
- _model = model;
- _aip.init(_model);
- */
- //SetModel(model);
-
- ATC = globals->get_ATC_mgr();
-
- // TODO - unhardwire this
- plane.type = GA_SINGLE;
-
- _roll = 0.0;
- _pitch = 0.0;
- _hdg = 270.0;
-
- //Hardwire initialisation for now - a lot of this should be read in from config eventually
- Vr = 70.0;
- best_rate_of_climb_speed = 70.0;
- //best_rate_of_climb;
- //nominal_climb_speed;
- //nominal_climb_rate;
- //nominal_circuit_speed;
- //min_circuit_speed;
- //max_circuit_speed;
- nominal_descent_rate = 500.0;
- nominal_final_speed = 65.0;
- //nominal_approach_speed;
- //stall_speed_landing_config;
- nominalTaxiSpeed = 7.5;
- taxiTurnRadius = 8.0;
- wheelOffset = 1.45; // Warning - hardwired to the C172 - we need to read this in from file.
- elevInitGood = false;
- // Init the property nodes
- wind_from_hdg = fgGetNode("/environment/wind-from-heading-deg", true);
- wind_speed_knots = fgGetNode("/environment/wind-speed-kt", true);
- circuitsToFly = 0;
- liningUp = false;
- taxiRequestPending = false;
- taxiRequestCleared = false;
- holdingShort = false;
- clearedToLineUp = false;
- clearedToTakeOff = false;
- _clearedToLand = false;
- reportReadyForDeparture = false;
- contactTower = false;
- contactGround = false;
- _taxiToGA = false;
- _removeSelf = false;
-
- descending = false;
- targetDescentRate = 0.0;
- goAround = false;
- goAroundCalled = false;
-
- transmitted = false;
-
- freeTaxi = false;
- _savedSlope = 0.0;
-
- _controlled = false;
-
- _invisible = false;
-}
-
-FGAILocalTraffic::~FGAILocalTraffic() {
-}
-
-void FGAILocalTraffic::GetAirportDetails(const string& id) {
- AirportATC a;
- if(ATC->GetAirportATCDetails(airportID, &a)) {
- if(a.tower_freq) { // Has a tower - TODO - check the opening hours!!!
- tower = (FGTower*)ATC->GetATCPointer(airportID, TOWER);
- if(tower == NULL) {
- // Something has gone wrong - abort or carry on with un-towered operation?
- SG_LOG(SG_ATC, SG_ALERT, "ERROR - can't get a tower pointer from tower control for " << airportID << " in FGAILocalTraffic::GetAirportDetails() :-(");
- _controlled = false;
- } else {
- _controlled = true;
- }
- if(tower) {
- ground = tower->GetGroundPtr();
- if(ground == NULL) {
- // Something has gone wrong :-(
- SG_LOG(SG_ATC, SG_ALERT, "ERROR - can't get a ground pointer from tower control in FGAILocalTraffic::GetAirportDetails() :-(");
- }
- }
- } else {
- _controlled = false;
- // TODO - Check CTAF, unicom etc
- }
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "Unable to find airport details in for " << airportID << " in FGAILocalTraffic::GetAirportDetails() :-(");
- _controlled = false;
- }
- // Get the airport elevation
- aptElev = fgGetAirportElev(airportID.c_str());
- //cout << "Airport elev in AILocalTraffic = " << aptElev << '\n';
- // WARNING - we use this elev for the whole airport - some assumptions in the code
- // might fall down with very slopey airports.
-}
-
-// Get details of the active runway
-// It is assumed that by the time this is called the tower control and airport code will have been set up.
-void FGAILocalTraffic::GetRwyDetails(const string& id) {
- //cout << "GetRwyDetails called" << endl;
-
- if(_controlled) {
- rwy.rwyID = tower->GetActiveRunway();
- } else {
- // TODO - get a proper runway ID from uncontrolled airports
- rwy.rwyID = "00";
- }
-
- // Now we need to get the threshold position and rwy heading
-
- FGRunway runway;
- bool rwyGood = globals->get_runways()->search(id, rwy.rwyID, &runway);
- if(rwyGood) {
- double hdg = runway._heading;
- double other_way = hdg - 180.0;
- while(other_way <= 0.0) {
- other_way += 360.0;
- }
-
- // move to the +l end/center of the runway
- //cout << "Runway center is at " << runway._lon << ", " << runway._lat << '\n';
- Point3D origin = Point3D(runway._lon, runway._lat, aptElev);
- Point3D ref = origin;
- double tshlon, tshlat, tshr;
- double tolon, tolat, tor;
- rwy.length = runway._length * SG_FEET_TO_METER;
- rwy.width = runway._width * SG_FEET_TO_METER;
- geo_direct_wgs_84 ( aptElev, ref.lat(), ref.lon(), other_way,
- rwy.length / 2.0 - 25.0, &tshlat, &tshlon, &tshr );
- geo_direct_wgs_84 ( aptElev, ref.lat(), ref.lon(), hdg,
- rwy.length / 2.0 - 25.0, &tolat, &tolon, &tor );
- // Note - 25 meters in from the runway end is a bit of a hack to put the plane ahead of the user.
- // now copy what we need out of runway into rwy
- rwy.threshold_pos = Point3D(tshlon, tshlat, aptElev);
- Point3D takeoff_end = Point3D(tolon, tolat, aptElev);
- //cout << "Threshold position = " << tshlon << ", " << tshlat << ", " << aptElev << '\n';
- //cout << "Takeoff position = " << tolon << ", " << tolat << ", " << aptElev << '\n';
- rwy.hdg = hdg;
- // Set the projection for the local area
- //cout << "Initing ortho for airport " << id << '\n';
- ortho.Init(rwy.threshold_pos, rwy.hdg);
- rwy.end1ortho = ortho.ConvertToLocal(rwy.threshold_pos); // should come out as zero
- rwy.end2ortho = ortho.ConvertToLocal(takeoff_end);
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "Help - can't get good runway at airport " << id << " in FGAILocalTraffic!!");
- }
-}
-
-
-/*
-There are two possible scenarios during initialisation:
-The first is that the user is flying towards the airport, and hence the traffic
-could be initialised anywhere, as long as the AI planes are consistent with
-each other.
-The second is that the user has started the sim at or close to the airport, and
-hence the traffic must be initialised with respect to the user as well as each other.
-To a certain extent it's FGAIMgr that has to worry about this, but we need to provide
-sufficient initialisation functionality within the plane classes to allow the manager
-to initially position them where and how required.
-*/
-bool FGAILocalTraffic::Init(const string& callsign, const string& ICAO, OperatingState initialState, PatternLeg initialLeg) {
- //cout << "FGAILocalTraffic.Init(...) called" << endl;
- airportID = ICAO;
-
- plane.callsign = callsign;
-
- if(initialState == EN_ROUTE) return(true);
-
- // Get the ATC pointers and airport elev
- GetAirportDetails(airportID);
-
- // Get the active runway details (and copy them into rwy)
- GetRwyDetails(airportID);
- //cout << "Runway is " << rwy.rwyID << '\n';
-
- // FIXME TODO - pattern direction is still hardwired
- patternDirection = -1; // Left
- // At the bare minimum we ought to make sure it goes the right way at dual parallel rwy airports!
- if(rwy.rwyID.size() == 3) {
- patternDirection = (rwy.rwyID.substr(2,1) == "R" ? 1 : -1);
- }
-
- if(_controlled) {
- if((initialState == PARKED) || (initialState == TAXIING)) {
- freq = (double)ground->get_freq() / 100.0;
- } else {
- freq = (double)tower->get_freq() / 100.0;
- }
- } else {
- freq = 122.8;
- // TODO - find the proper freq if CTAF or unicom or after-hours.
- }
-
- //cout << "In Init(), initialState = " << initialState << endl;
- operatingState = initialState;
- Point3D orthopos;
- switch(operatingState) {
- case PARKED:
- tuned_station = ground;
- ourGate = ground->GetGateNode();
- if(ourGate == NULL) {
- // Implies no available gates - what shall we do?
- // For now just vanish the plane - possibly we can make this more elegant in the future
- SG_LOG(SG_ATC, SG_ALERT, "No gate found by FGAILocalTraffic whilst attempting Init at " << airportID << '\n');
- return(false);
- }
- _pitch = 0.0;
- _roll = 0.0;
- vel = 0.0;
- slope = 0.0;
- _pos = ourGate->pos;
- _pos.setelev(aptElev);
- _hdg = ourGate->heading;
- Transform();
-
- // Now we've set the position we can do the ground elev
- elevInitGood = false;
- inAir = false;
- DoGroundElev();
-
- break;
- case TAXIING:
- //tuned_station = ground;
- // FIXME - implement this case properly
- // For now we'll assume that the plane should start at the hold short in this case
- // and that we're working without ground network elements. Ie. an airport with no facility file.
- if(_controlled) {
- tuned_station = tower;
- } else {
- tuned_station = NULL;
- }
- freeTaxi = true;
- // Set a position and orientation in an approximate place for hold short.
- //cout << "rwy.width = " << rwy.width << '\n';
- orthopos = Point3D((rwy.width / 2.0 + 10.0) * -1.0, 0.0, 0.0);
- // TODO - set the x pos to be +ve if a RH parallel rwy.
- _pos = ortho.ConvertFromLocal(orthopos);
- _pos.setelev(aptElev);
- _hdg = rwy.hdg + 90.0;
- // TODO - reset the heading if RH rwy.
- _pitch = 0.0;
- _roll = 0.0;
- vel = 0.0;
- slope = 0.0;
- elevInitGood = false;
- inAir = false;
- Transform();
- DoGroundElev();
- //Transform();
-
- responseCounter = 0.0;
- contactTower = false;
- changeFreq = true;
- holdingShort = true;
- clearedToLineUp = false;
- changeFreqType = TOWER;
-
- break;
- case IN_PATTERN:
- // For now we'll always start the in_pattern case on the threshold ready to take-off
- // since we've got the implementation for this case already.
- // TODO - implement proper generic in_pattern startup.
-
- // 18/10/03 - adding the ability to start on downwind (mainly to speed testing of the go-around code!!)
-
- //cout << "Starting in pattern...\n";
-
- if(_controlled) {
- tuned_station = tower;
- } else {
- tuned_station = NULL;
- }
-
- circuitsToFly = 0; // ie just fly this circuit and then stop
- touchAndGo = false;
-
- if(initialLeg == DOWNWIND) {
- _pos = ortho.ConvertFromLocal(Point3D(1000*patternDirection, 800, 0.0));
- _pos.setelev(rwy.threshold_pos.elev() + 1000 * SG_FEET_TO_METER);
- _hdg = rwy.hdg + 180.0;
- leg = DOWNWIND;
- elevInitGood = false;
- inAir = true;
- SetTrack(rwy.hdg - (180 * patternDirection));
- slope = 0.0;
- _pitch = 0.0;
- _roll = 0.0;
- IAS = 90.0;
- descending = false;
- _aip.setVisible(true);
- if(_controlled) {
- tower->RegisterAIPlane(plane, this, CIRCUIT, DOWNWIND);
- }
- Transform();
- } else {
- // Default to initial position on threshold for now
- _pos.setlat(rwy.threshold_pos.lat());
- _pos.setlon(rwy.threshold_pos.lon());
- _pos.setelev(rwy.threshold_pos.elev());
- _hdg = rwy.hdg;
-
- // Now we've set the position we can do the ground elev
- // This might not always be necessary if we implement in-air start
- elevInitGood = false;
- inAir = false;
-
- _pitch = 0.0;
- _roll = 0.0;
- leg = TAKEOFF_ROLL;
- vel = 0.0;
- slope = 0.0;
-
- Transform();
- DoGroundElev();
- }
-
- operatingState = IN_PATTERN;
-
- break;
- case EN_ROUTE:
- // This implies we're being init'd by AIGAVFRTraffic - simple return now
- return(true);
- default:
- SG_LOG(SG_ATC, SG_ALERT, "Attempt to set unknown operating state in FGAILocalTraffic.Init(...)\n");
- return(false);
- }
-
-
- return(true);
-}
-
-
-// Set up downwind state - this is designed to be called from derived classes who are already tuned to tower
-void FGAILocalTraffic::DownwindEntry() {
- circuitsToFly = 0; // ie just fly this circuit and then stop
- touchAndGo = false;
- operatingState = IN_PATTERN;
- leg = DOWNWIND;
- elevInitGood = false;
- inAir = true;
- SetTrack(rwy.hdg - (180 * patternDirection));
- slope = 0.0;
- _pitch = 0.0;
- _roll = 0.0;
- IAS = 90.0;
- descending = false;
-}
-
-void FGAILocalTraffic::StraightInEntry(bool des) {
- //cout << "************ STRAIGHT-IN ********************\n";
- circuitsToFly = 0; // ie just fly this circuit and then stop
- touchAndGo = false;
- operatingState = IN_PATTERN;
- leg = FINAL;
- elevInitGood = false;
- inAir = true;
- SetTrack(rwy.hdg);
- transmitted = true; // TODO - fix this hack.
- // TODO - set up the next 5 properly for a descent!
- slope = -5.5;
- _pitch = 0.0;
- _roll = 0.0;
- IAS = 90.0;
- descending = des;
-}
-
-
-// Return what type of landing we're doing on this circuit
-LandingType FGAILocalTraffic::GetLandingOption() {
- //cout << "circuitsToFly = " << circuitsToFly << '\n';
- if(circuitsToFly) {
- return(touchAndGo ? TOUCH_AND_GO : STOP_AND_GO);
- } else {
- return(FULL_STOP);
- }
-}
-
-
-// Commands to do something from higher level logic
-void FGAILocalTraffic::FlyCircuits(int numCircuits, bool tag) {
- //cout << "FlyCircuits called" << endl;
-
- switch(operatingState) {
- case IN_PATTERN:
- circuitsToFly += numCircuits;
- return;
- break;
- case TAXIING:
- // HACK - assume that we're taxiing out for now
- circuitsToFly += numCircuits;
- touchAndGo = tag;
- break;
- case PARKED:
- circuitsToFly = numCircuits; // Note that one too many circuits gets flown because we only test and decrement circuitsToFly after landing
- // thus flying one too many circuits. TODO - Need to sort this out better!
- touchAndGo = tag;
- break;
- case EN_ROUTE:
- break;
- }
-}
-
-// Run the internal calculations
-void FGAILocalTraffic::Update(double dt) {
- //cout << "U" << flush;
-
- // we shouldn't really need this since there's a LOD of 10K on the whole plane anyway I think.
- // At the moment though I need to to avoid DList overflows - the whole plane LOD obviously isn't getting picked up.
- if(!_invisible) {
- if(dclGetHorizontalSeparation(_pos, Point3D(fgGetDouble("/position/longitude-deg"), fgGetDouble("/position/latitude-deg"), 0.0)) > 8000) _aip.setVisible(false);
- else _aip.setVisible(true);
- } else {
- _aip.setVisible(false);
- }
-
- //double responseTime = 10.0; // seconds - this should get more sophisticated at some point
- responseCounter += dt;
- if((contactTower) && (responseCounter >= 8.0)) {
- // Acknowledge request before changing frequency so it gets rendered if the user is on the same freq
- string trns = "Tower ";
- double f = globals->get_ATC_mgr()->GetFrequency(airportID, TOWER) / 100.0;
- char buf[10];
- sprintf(buf, "%.2f", f);
- trns += buf;
- trns += " ";
- trns += plane.callsign;
- pending_transmission = trns;
- ConditionalTransmit(30.0);
- responseCounter = 0.0;
- contactTower = false;
- changeFreq = true;
- changeFreqType = TOWER;
- }
-
- if((contactGround) && (responseCounter >= 8.0)) {
- // Acknowledge request before changing frequency so it gets rendered if the user is on the same freq
- string trns = "Ground ";
- double f = globals->get_ATC_mgr()->GetFrequency(airportID, GROUND) / 100.0;
- char buf[10];
- sprintf(buf, "%.2f", f);
- trns += buf;
- trns += " ";
- trns += "Good Day";
- pending_transmission = trns;
- ConditionalTransmit(5.0);
- responseCounter = 0.0;
- contactGround = false;
- changeFreq = true;
- changeFreqType = GROUND;
- }
-
- if((_taxiToGA) && (responseCounter >= 8.0)) {
- // Acknowledge request before changing frequency so it gets rendered if the user is on the same freq
- string trns = "GA Parking, Thank you and Good Day";
- //double f = globals->get_ATC_mgr()->GetFrequency(airportID, GROUND) / 100.0;
- pending_transmission = trns;
- ConditionalTransmit(5.0, 99);
- _taxiToGA = false;
- if(_controlled) {
- tower->DeregisterAIPlane(plane.callsign);
- }
- // NOTE - we can't delete this instance yet since then the frequency won't get release when the message display finishes.
- }
-
- if((_removeSelf) && (responseCounter >= 8.0)) {
- _removeSelf = false;
- // MEGA HACK - check if we are at a simple airport or not first instead of simply hardwiring KEMT as the only non-simple airport.
- // TODO FIXME TODO FIXME !!!!!!!
- if(airportID != "KEMT") globals->get_AI_mgr()->ScheduleRemoval(plane.callsign);
- }
-
- if((changeFreq) && (responseCounter > 8.0)) {
- switch(changeFreqType) {
- case TOWER:
- if(!tower) {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR: Trying to change frequency to tower in FGAILocalTraffic, but tower is NULL!!!");
- break;
- }
- tuned_station = tower;
- freq = (double)tower->get_freq() / 100.0;
- //Transmit("DING!");
- // Contact the tower, even if only virtually
- pending_transmission = plane.callsign;
- pending_transmission += " at hold short for runway ";
- pending_transmission += ConvertRwyNumToSpokenString(rwy.rwyID);
- pending_transmission += " traffic pattern ";
- if(circuitsToFly) {
- pending_transmission += ConvertNumToSpokenDigits(circuitsToFly + 1);
- pending_transmission += " circuits touch and go";
- } else {
- pending_transmission += " one circuit to full stop";
- }
- Transmit(2);
- break;
- case GROUND:
- if(!tower) {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR: Trying to change frequency to ground in FGAILocalTraffic, but tower is NULL!!!");
- break;
- }
- if(!ground) {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR: Trying to change frequency to ground in FGAILocalTraffic, but ground is NULL!!!");
- break;
- }
- tower->DeregisterAIPlane(plane.callsign);
- tuned_station = ground;
- freq = (double)ground->get_freq() / 100.0;
- break;
- // And to avoid compiler warnings...
- case APPROACH: break;
- case ATIS: break;
- case ENROUTE: break;
- case DEPARTURE: break;
- case INVALID: break;
- }
- changeFreq = false;
- }
-
- //cout << "," << flush;
-
- switch(operatingState) {
- case IN_PATTERN:
- //cout << "In IN_PATTERN\n";
- if(!inAir) {
- DoGroundElev();
- if(!elevInitGood) {
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990.0) {
- _pos.setelev(_aip.getSGLocation()->get_cur_elev_m() + wheelOffset);
- //cout << "TAKEOFF_ROLL, POS = " << pos.lon() << ", " << pos.lat() << ", " << pos.elev() << '\n';
- //Transform();
- _aip.setVisible(true);
- //cout << "Making plane visible!\n";
- elevInitGood = true;
- }
- }
- }
- FlyTrafficPattern(dt);
- Transform();
- break;
- case TAXIING:
- //cout << "In TAXIING\n";
- //cout << "*" << flush;
- if(!elevInitGood) {
- //DoGroundElev();
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990.0) {
- _pos.setelev(_aip.getSGLocation()->get_cur_elev_m() + wheelOffset);
- //Transform();
- _aip.setVisible(true);
- //Transform();
- //cout << "Making plane visible!\n";
- elevInitGood = true;
- }
- }
- DoGroundElev();
- //cout << "~" << flush;
- if(!((holdingShort) && (!clearedToLineUp))) {
- //cout << "|" << flush;
- Taxi(dt);
- }
- //cout << ";" << flush;
- if((clearedToTakeOff) && (responseCounter >= 8.0)) {
- // possible assumption that we're at the hold short here - may not always hold
- // TODO - sort out the case where we're cleared to line-up first and then cleared to take-off on the rwy.
- taxiState = TD_LINING_UP;
- //cout << "A" << endl;
- path = ground->GetPath(holdShortNode, rwy.rwyID);
- //cout << "B" << endl;
- if(!path.size()) { // Assume no facility file so we'll just taxi to a point on the runway near the threshold
- //cout << "C" << endl;
- node* np = new node;
- np->struct_type = NODE;
- np->pos = ortho.ConvertFromLocal(Point3D(0.0, 10.0, 0.0));
- path.push_back(np);
- } else {
- //cout << "D" << endl;
- }
- /*
- cout << "path returned was:" << endl;
- for(unsigned int i=0; i<path.size(); ++i) {
- switch(path[i]->struct_type) {
- case NODE:
- cout << "NODE " << ((node*)(path[i]))->nodeID << endl;
- break;
- case ARC:
- cout << "ARC\n";
- break;
- }
- }
- */
- clearedToTakeOff = false; // We *are* still cleared - this simply stops the response recurring!!
- holdingShort = false;
- string trns = "Cleared for take-off ";
- trns += plane.callsign;
- pending_transmission = trns;
- Transmit();
- StartTaxi();
- }
- //cout << "^" << flush;
- Transform();
- break;
- case PARKED:
- //cout << "In PARKED\n";
- if(!elevInitGood) {
- DoGroundElev();
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990.0) {
- _pos.setelev(_aip.getSGLocation()->get_cur_elev_m() + wheelOffset);
- //Transform();
- _aip.setVisible(true);
- //Transform();
- //cout << "Making plane visible!\n";
- elevInitGood = true;
- }
- }
-
- if(circuitsToFly) {
- if((taxiRequestPending) && (taxiRequestCleared)) {
- //cout << "&" << flush;
- // Get the active runway details (in case they've changed since init)
- GetRwyDetails(airportID);
-
- // Get the takeoff node for the active runway, get a path to it and start taxiing
- path = ground->GetPathToHoldShort(ourGate, rwy.rwyID);
- if(path.size() < 2) {
- // something has gone wrong
- SG_LOG(SG_ATC, SG_ALERT, "Invalid path from gate to theshold in FGAILocalTraffic::FlyCircuits\n");
- return;
- }
- /*
- cout << "path returned was:\n";
- for(unsigned int i=0; i<path.size(); ++i) {
- switch(path[i]->struct_type) {
- case NODE:
- cout << "NODE " << ((node*)(path[i]))->nodeID << endl;
- break;
- case ARC:
- cout << "ARC\n";
- break;
- }
- }
- */
- path.erase(path.begin()); // pop the gate - we're here already!
- taxiState = TD_OUTBOUND;
- taxiRequestPending = false;
- holdShortNode = (node*)(*(path.begin() + path.size()));
- StartTaxi();
- } else if(!taxiRequestPending) {
- //cout << "(" << flush;
- // Do some communication
- // airport name + tower + airplane callsign + location + request taxi for + operation type + ?
- string trns = "";
- if(_controlled) {
- trns += tower->get_name();
- trns += " tower ";
- } else {
- trns += "Traffic ";
- // TODO - get the airport name somehow if uncontrolled
- }
- trns += plane.callsign;
- trns += " on apron parking request taxi for traffic pattern";
- //cout << "trns = " << trns << endl;
- pending_transmission = trns;
- Transmit(1);
- taxiRequestCleared = false;
- taxiRequestPending = true;
- }
- }
-
- //cout << "!" << flush;
-
- // Maybe the below should be set when we get to the threshold and prepare for TO?
- // FIXME TODO - pattern direction is still hardwired
- patternDirection = -1; // Left
- // At the bare minimum we ought to make sure it goes the right way at dual parallel rwy airports!
- if(rwy.rwyID.size() == 3) {
- patternDirection = (rwy.rwyID.substr(2,1) == "R" ? 1 : -1);
- }
- // Do nothing
- Transform();
- //cout << ")" << flush;
- break;
- default:
- break;
- }
- //cout << "I " << flush;
-
- //cout << "Update _pos = " << _pos << ", vis = " << _aip.getVisible() << '\n';
-
- // Convienience output for AI debugging using the property logger
- //fgSetDouble("/AI/Local1/ortho-x", (ortho.ConvertToLocal(_pos)).x());
- //fgSetDouble("/AI/Local1/ortho-y", (ortho.ConvertToLocal(_pos)).y());
- //fgSetDouble("/AI/Local1/elev", _pos.elev() * SG_METER_TO_FEET);
-
- // And finally, call parent.
- FGAIPlane::Update(dt);
-}
-
-void FGAILocalTraffic::RegisterTransmission(int code) {
- switch(code) {
- case 1: // taxi request cleared
- taxiRequestCleared = true;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " cleared to taxi...");
- break;
- case 2: // contact tower
- responseCounter = 0;
- contactTower = true;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " told to contact tower...");
- break;
- case 3: // Cleared to line up
- responseCounter = 0;
- clearedToLineUp = true;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " cleared to line-up...");
- break;
- case 4: // cleared to take-off
- responseCounter = 0;
- clearedToTakeOff = true;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " cleared to take-off...");
- break;
- case 5: // contact ground
- responseCounter = 0;
- contactGround = true;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " told to contact ground...");
- break;
- // case 6 is a temporary mega-hack for controlled airports without separate ground control
- case 6: // taxi to the GA parking
- responseCounter = 0;
- _taxiToGA = true;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " told to taxi to the GA parking...");
- break;
- case 7: // Cleared to land (also implies cleared for the option
- _clearedToLand = true;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " cleared to land...");
- break;
- case 13: // Go around!
- responseCounter = 0;
- goAround = true;
- _clearedToLand = false;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " told to go-around!!");
- break;
- default:
- break;
- }
-}
-
-// Fly a traffic pattern
-// FIXME - far too much of the mechanics of turning, rolling, accellerating, descending etc is in here.
-// Move it out to FGAIPlane and have FlyTrafficPattern just specify what to do, not the implementation.
-void FGAILocalTraffic::FlyTrafficPattern(double dt) {
- // Need to differentiate between in-air (IAS governed) and on-ground (vel governed)
- // Take-off is an interesting case - we are on the ground but takeoff speed is IAS governed.
-
- // WIND
- // Wind has two effects - a mechanical one in that IAS translates to a different vel, and the hdg != track,
- // but also a piloting effect, in that the AI must be able to descend at a different rate in order to hit the threshold.
-
- //cout << "dt = " << dt << '\n';
- double dist = 0;
- // ack - I can't remember how long a rate 1 turn is meant to take.
- double turn_time = 60.0; // seconds - TODO - check this guess
- double turn_circumference;
- double turn_radius;
- Point3D orthopos = ortho.ConvertToLocal(_pos); // ortho position of the plane
- //cout << "runway elev = " << rwy.threshold_pos.elev() << ' ' << rwy.threshold_pos.elev() * SG_METER_TO_FEET << '\n';
- //cout << "elev = " << _pos.elev() << ' ' << _pos.elev() * SG_METER_TO_FEET << '\n';
-
- // HACK FOR TESTING - REMOVE
- //cout << "Calling ExitRunway..." << endl;
- //ExitRunway(orthopos);
- //return;
- // END HACK
-
- //wind
- double wind_from = wind_from_hdg->getDoubleValue();
- double wind_speed = wind_speed_knots->getDoubleValue();
-
- double dveldt;
-
- switch(leg) {
- case TAKEOFF_ROLL:
- //inAir = false;
- track = rwy.hdg;
- if(vel < 80.0) {
- double dveldt = 5.0;
- vel += dveldt * dt;
- }
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990.0) {
- _pos.setelev(_aip.getSGLocation()->get_cur_elev_m() + wheelOffset);
- }
- IAS = vel + (cos((_hdg - wind_from) * DCL_DEGREES_TO_RADIANS) * wind_speed);
- if(IAS >= 70) {
- leg = CLIMBOUT;
- SetTrack(rwy.hdg); // Hands over control of turning to AIPlane
- _pitch = 10.0;
- IAS = best_rate_of_climb_speed;
- //slope = 7.0;
- slope = 6.0; // Reduced it slightly since it's climbing a lot steeper than I can in the JSBSim C172.
- inAir = true;
- }
- break;
- case CLIMBOUT:
- // Turn to crosswind if above 700ft AND if other traffic allows
- // (decided in FGTower and accessed through GetCrosswindConstraint(...)).
- // According to AIM, traffic should climb to within 300ft of pattern altitude before commencing crosswind turn.
- // TODO - At hot 'n high airports this may be 500ft AGL though - need to make this a variable.
- if((_pos.elev() - rwy.threshold_pos.elev()) * SG_METER_TO_FEET > 700) {
- double cc = 0.0;
- if(tower->GetCrosswindConstraint(cc)) {
- if(orthopos.y() > cc) {
- //cout << "Turning to crosswind, distance from threshold = " << orthopos.y() << '\n';
- leg = TURN1;
- }
- } else if(orthopos.y() > 1500.0) { // Added this constraint as a hack to prevent turning too early when going around.
- // TODO - We should be doing it as a distance from takeoff end, not theshold end though.
- //cout << "Turning to crosswind, distance from threshold = " << orthopos.y() << '\n';
- leg = TURN1;
- }
- }
- // Need to check for levelling off in case we can't turn crosswind as soon
- // as we would like due to other traffic.
- if((_pos.elev() - rwy.threshold_pos.elev()) * SG_METER_TO_FEET > 1000) {
- slope = 0.0;
- _pitch = 0.0;
- IAS = 80.0; // FIXME - use smooth transistion to new speed and attitude.
- }
- if(goAround && !goAroundCalled) {
- if(responseCounter > 5.5) {
- pending_transmission = plane.callsign;
- pending_transmission += " going around";
- Transmit();
- goAroundCalled = true;
- }
- }
- break;
- case TURN1:
- SetTrack(rwy.hdg + (90.0 * patternDirection));
- if((track < (rwy.hdg - 89.0)) || (track > (rwy.hdg + 89.0))) {
- leg = CROSSWIND;
- }
- break;
- case CROSSWIND:
- goAround = false;
- if((_pos.elev() - rwy.threshold_pos.elev()) * SG_METER_TO_FEET > 1000) {
- slope = 0.0;
- _pitch = 0.0;
- IAS = 80.0; // FIXME - use smooth transistion to new speed
- }
- // turn 1000m out for now, taking other traffic into accout
- if(fabs(orthopos.x()) > 900) {
- double dd = 0.0;
- if(tower->GetDownwindConstraint(dd)) {
- if(fabs(orthopos.x()) > fabs(dd)) {
- //cout << "Turning to downwind, distance from centerline = " << fabs(orthopos.x()) << '\n';
- leg = TURN2;
- }
- } else {
- //cout << "Turning to downwind, distance from centerline = " << fabs(orthopos.x()) << '\n';
- leg = TURN2;
- }
- }
- break;
- case TURN2:
- SetTrack(rwy.hdg - (180 * patternDirection));
- // just in case we didn't make height on crosswind
- if((_pos.elev() - rwy.threshold_pos.elev()) * SG_METER_TO_FEET > 1000) {
- slope = 0.0;
- _pitch = 0.0;
- IAS = 80.0; // FIXME - use smooth transistion to new speed
- }
- if((track < (rwy.hdg - 179.0)) || (track > (rwy.hdg + 179.0))) {
- leg = DOWNWIND;
- transmitted = false;
- }
- break;
- case DOWNWIND:
- // just in case we didn't make height on crosswind
- if(((_pos.elev() - rwy.threshold_pos.elev()) * SG_METER_TO_FEET > 995) && ((_pos.elev() - rwy.threshold_pos.elev()) * SG_METER_TO_FEET < 1015)) {
- slope = 0.0;
- _pitch = 0.0;
- IAS = 90.0; // FIXME - use smooth transistion to new speed
- }
- if((_pos.elev() - rwy.threshold_pos.elev()) * SG_METER_TO_FEET >= 1015) {
- slope = -1.0;
- _pitch = -1.0;
- IAS = 90.0; // FIXME - use smooth transistion to new speed
- }
- if((orthopos.y() < 0) && (!transmitted)) {
- TransmitPatternPositionReport();
- transmitted = true;
- }
- if((orthopos.y() < -100) && (!descending)) {
- //cout << "DDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDDdddd\n";
- // Maybe we should think about when to start descending.
- // For now we're assuming that we aim to follow the same glidepath regardless of wind.
- double d1;
- double d2;
- CalculateSoD((tower->GetBaseConstraint(d1) ? d1 : -1000.0), (tower->GetDownwindConstraint(d2) ? d2 : 1000.0 * patternDirection), (patternDirection ? true : false));
- if(SoD.leg == DOWNWIND) {
- descending = (orthopos.y() < SoD.y ? true : false);
- }
-
- }
- if(descending) {
- slope = -5.5; // FIXME - calculate to descent at 500fpm and hit the desired point on the runway (taking wind into account as well!!)
- _pitch = -3.0;
- IAS = 85.0;
- }
-
- // Try and arrange to turn nicely onto base
- turn_circumference = IAS * 0.514444 * turn_time;
- //Hmmm - this is an interesting one - ground vs airspeed in relation to turn radius
- //We'll leave it as a hack with IAS for now but it needs revisiting.
- turn_radius = turn_circumference / (2.0 * DCL_PI);
- if(orthopos.y() < -1000.0 + turn_radius) {
- //if(orthopos.y() < -980) {
- double bb = 0.0;
- if(tower->GetBaseConstraint(bb)) {
- if(fabs(orthopos.y()) > fabs(bb)) {
- //cout << "Turning to base, distance from threshold = " << fabs(orthopos.y()) << '\n';
- leg = TURN3;
- transmitted = false;
- IAS = 80.0;
- }
- } else {
- //cout << "Turning to base, distance from threshold = " << fabs(orthopos.y()) << '\n';
- leg = TURN3;
- transmitted = false;
- IAS = 80.0;
- }
- }
- break;
- case TURN3:
- SetTrack(rwy.hdg - (90 * patternDirection));
- if(fabs(rwy.hdg - track) < 91.0) {
- leg = BASE;
- }
- break;
- case BASE:
- if(!transmitted) {
- // Base report should only be transmitted at uncontrolled airport - not towered.
- if(!_controlled) TransmitPatternPositionReport();
- transmitted = true;
- }
-
- if(!descending) {
- double d1;
- // Make downwind leg position artifically large to avoid any chance of SoD being returned as
- // on downwind when we are already on base.
- CalculateSoD((tower->GetBaseConstraint(d1) ? d1 : -1000.0), (10000.0 * patternDirection), (patternDirection ? true : false));
- if(SoD.leg == BASE) {
- descending = (fabs(orthopos.y()) < fabs(SoD.y) ? true : false);
- }
-
- }
- if(descending) {
- slope = -5.5; // FIXME - calculate to descent at 500fpm and hit the threshold (taking wind into account as well!!)
- _pitch = -4.0;
- IAS = 70.0;
- }
-
- // Try and arrange to turn nicely onto final
- turn_circumference = IAS * 0.514444 * turn_time;
- //Hmmm - this is an interesting one - ground vs airspeed in relation to turn radius
- //We'll leave it as a hack with IAS for now but it needs revisiting.
- turn_radius = turn_circumference / (2.0 * DCL_PI);
- if(fabs(orthopos.x()) < (turn_radius + 50)) {
- leg = TURN4;
- transmitted = false;
- //roll = -20;
- }
- break;
- case TURN4:
- SetTrack(rwy.hdg);
- if(fabs(track - rwy.hdg) < 0.6) {
- leg = FINAL;
- vel = nominal_final_speed;
- }
- break;
- case FINAL:
- if(goAround && responseCounter > 2.0) {
- leg = CLIMBOUT;
- _pitch = 8.0;
- IAS = best_rate_of_climb_speed;
- slope = 5.0; // A bit less steep than the initial climbout.
- inAir = true;
- goAroundCalled = false;
- descending = false;
- break;
- }
- LevelWings();
- if(!transmitted) {
- if((!_controlled) || (!_clearedToLand)) TransmitPatternPositionReport();
- transmitted = true;
- }
- if(!descending) {
- // Make base leg position artifically large to avoid any chance of SoD being returned as
- // on base or downwind when we are already on final.
- CalculateSoD(-10000.0, (1000.0 * patternDirection), (patternDirection ? true : false));
- if(SoD.leg == FINAL) {
- descending = (fabs(orthopos.y()) < fabs(SoD.y) ? true : false);
- }
-
- }
- if(descending) {
- if(orthopos.y() < -50.0) {
- double thesh_offset = 30.0;
- slope = atan((_pos.elev() - fgGetAirportElev(airportID)) / (orthopos.y() - thesh_offset)) * DCL_RADIANS_TO_DEGREES;
- //cout << "slope = " << slope << ", elev = " << _pos.elev() << ", apt_elev = " << fgGetAirportElev(airportID) << ", op.y = " << orthopos.y() << '\n';
- if(slope < -10.0) slope = -10.0;
- _savedSlope = slope;
- _pitch = -4.0;
- IAS = 70.0;
- } else {
- if(_pos.elev() < (rwy.threshold_pos.elev()+10.0+wheelOffset)) {
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990.0) {
- if(_pos.elev() < (_aip.getSGLocation()->get_cur_elev_m() + wheelOffset + 1.0)) {
- slope = -2.0;
- _pitch = 1.0;
- IAS = 55.0;
- } else if(_pos.elev() < (_aip.getSGLocation()->get_cur_elev_m() + wheelOffset + 5.0)) {
- slope = -4.0;
- _pitch = -2.0;
- IAS = 60.0;
- } else {
- slope = _savedSlope;
- _pitch = -3.0;
- IAS = 65.0;
- }
- } else {
- // Elev not determined
- slope = _savedSlope;
- _pitch = -3.0;
- IAS = 65.0;
- }
- } else {
- slope = _savedSlope;
- _pitch = -3.0;
- IAS = 65.0;
- }
- }
- }
- // Try and track the extended centreline
- SetTrack(rwy.hdg - (0.2 * orthopos.x()));
- //cout << "orthopos.x() = " << orthopos.x() << " hdg = " << hdg << '\n';
- if(_pos.elev() < (rwy.threshold_pos.elev()+20.0+wheelOffset)) {
- DoGroundElev(); // Need to call it here expicitly on final since it's only called
- // for us in update(...) when the inAir flag is false.
- }
- if(_pos.elev() < (rwy.threshold_pos.elev()+10.0+wheelOffset)) {
- //slope = -1.0;
- //_pitch = 1.0;
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990.0) {
- if((_aip.getSGLocation()->get_cur_elev_m() + wheelOffset) > _pos.elev()) {
- slope = 0.0;
- _pitch = 0.0;
- leg = LANDING_ROLL;
- inAir = false;
- LevelWings();
- ClearTrack(); // Take over explicit track handling since AIPlane currently always banks when changing course
- }
- } // else need a fallback position based on arpt elev in case ground elev determination fails?
- } else {
- // TODO
- }
- break;
- case LANDING_ROLL:
- //inAir = false;
- descending = false;
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990.0) {
- _pos.setelev(_aip.getSGLocation()->get_cur_elev_m() + wheelOffset);
- }
- track = rwy.hdg;
- dveldt = -5.0;
- vel += dveldt * dt;
- // FIXME - differentiate between touch and go and full stops
- if(vel <= 15.0) {
- //cout << "Vel <= 15.0, circuitsToFly = " << circuitsToFly << endl;
- if(circuitsToFly <= 0) {
- //cout << "Calling ExitRunway..." << endl;
- ExitRunway(orthopos);
- return;
- } else {
- //cout << "Taking off again..." << endl;
- leg = TAKEOFF_ROLL;
- --circuitsToFly;
- }
- }
- break;
- case LEG_UNKNOWN:
- break;
- }
-
- if(inAir) {
- // FIXME - at the moment this is a bit screwy
- // The velocity correction is applied based on the relative headings.
- // Then the heading is changed based on the velocity.
- // Which comes first, the chicken or the egg?
- // Does it really matter?
-
- // Apply wind to ground-relative velocity if in the air
- vel = IAS - (cos((_hdg - wind_from) * DCL_DEGREES_TO_RADIANS) * wind_speed);
- //crab = f(track, wind, vel);
- // The vector we need to fly is our desired vector minus the wind vector
- // TODO - we probably ought to use plib's built in vector types and operations for this
- // ie. There's almost *certainly* a better way to do this!
- double gxx = vel * sin(track * DCL_DEGREES_TO_RADIANS); // Plane desired velocity x component wrt ground
- double gyy = vel * cos(track * DCL_DEGREES_TO_RADIANS); // Plane desired velocity y component wrt ground
- double wxx = wind_speed * sin((wind_from + 180.0) * DCL_DEGREES_TO_RADIANS); // Wind velocity x component
- double wyy = wind_speed * cos((wind_from + 180.0) * DCL_DEGREES_TO_RADIANS); // Wind velocity y component
- double axx = gxx - wxx; // Plane in-air velocity x component
- double ayy = gyy - wyy; // Plane in-air velocity y component
- // Now we want the angle between gxx and axx (which is the crab)
- double maga = sqrt(axx*axx + ayy*ayy);
- double magg = sqrt(gxx*gxx + gyy*gyy);
- crab = acos((axx*gxx + ayy*gyy) / (maga * magg));
- // At this point this works except we're getting the modulus of the angle
- //cout << "crab = " << crab << '\n';
-
- // Make sure both headings are in the 0->360 circle in order to get sane differences
- dclBoundHeading(wind_from);
- dclBoundHeading(track);
- if(track > wind_from) {
- if((track - wind_from) <= 180) {
- crab *= -1.0;
- }
- } else {
- if((wind_from - track) >= 180) {
- crab *= -1.0;
- }
- }
- } else { // on the ground - crab dosen't apply
- crab = 0.0;
- }
-
- //cout << "X " << orthopos.x() << " Y " << orthopos.y() << " SLOPE " << slope << " elev " << _pos.elev() * SG_METER_TO_FEET << '\n';
-
- _hdg = track + crab;
- dist = vel * 0.514444 * dt;
- _pos = dclUpdatePosition(_pos, track, slope, dist);
-}
-
-// Pattern direction is true for right, false for left
-void FGAILocalTraffic::CalculateSoD(double base_leg_pos, double downwind_leg_pos, bool pattern_direction) {
- // For now we'll ignore wind and hardwire the glide angle.
- double ga = 5.5; //degrees
- double pa = 1000.0 * SG_FEET_TO_METER; // pattern altitude in meters
- // FIXME - get glideslope angle and pattern altitude agl from airport details if available
-
- // For convienience, we'll have +ve versions of the input distances
- double blp = fabs(base_leg_pos);
- double dlp = fabs(downwind_leg_pos);
-
- //double turn_allowance = 150.0; // Approximate distance in meters that a 90deg corner is shortened by turned in a light plane.
-
- double stod = pa / tan(ga * DCL_DEGREES_TO_RADIANS); // distance in meters from touchdown point to start descent
- //cout << "Descent to start = " << stod << " meters out\n";
- if(stod < blp) { // Start descending on final
- SoD.leg = FINAL;
- SoD.y = stod * -1.0;
- SoD.x = 0.0;
- } else if(stod < (blp + dlp)) { // Start descending on base leg
- SoD.leg = BASE;
- SoD.y = blp * -1.0;
- SoD.x = (pattern_direction ? (stod - dlp) : (stod - dlp) * -1.0);
- } else { // Start descending on downwind leg
- SoD.leg = DOWNWIND;
- SoD.x = (pattern_direction ? dlp : dlp * -1.0);
- SoD.y = (blp - (stod - (blp + dlp))) * -1.0;
- }
-}
-
-void FGAILocalTraffic::TransmitPatternPositionReport(void) {
- // airport name + "traffic" + airplane callsign + pattern direction + pattern leg + rwy + ?
- string trns = "";
- int code = 0;
-
- trns += tower->get_name();
- trns += " Traffic ";
- trns += plane.callsign;
- if(patternDirection == 1) {
- trns += " right ";
- } else {
- trns += " left ";
- }
-
- // We could probably get rid of this whole switch statement and just pass a string containing the leg from the FlyPattern function.
- switch(leg) { // We'll assume that transmissions in turns are intended for next leg - do pilots ever call out that they are in the turn?
- case TURN1:
- // Fall through to CROSSWIND
- case CROSSWIND: // I don't think this case will be used here but it can't hurt to leave it in
- trns += "crosswind ";
- break;
- case TURN2:
- // Fall through to DOWNWIND
- case DOWNWIND:
- trns += "downwind ";
- code = 11;
- break;
- case TURN3:
- // Fall through to BASE
- case BASE:
- trns += "base ";
- break;
- case TURN4:
- // Fall through to FINAL
- case FINAL: // maybe this should include long/short final if appropriate?
- trns += "final ";
- code = 13;
- break;
- default: // Hopefully this won't be used
- trns += "pattern ";
- break;
- }
- trns += ConvertRwyNumToSpokenString(rwy.rwyID);
-
- trns += " ";
-
- // And add the airport name again
- trns += tower->get_name();
-
- pending_transmission = trns;
- ConditionalTransmit(60.0, code); // Assume a report of this leg will be invalid if we can't transmit within a minute.
-}
-
-// Callback handler
-// TODO - Really should enumerate these coded values.
-void FGAILocalTraffic::ProcessCallback(int code) {
- // 1 - Request Departure from ground
- // 2 - Report at hold short
- // 3 - Report runway vacated
- // 10 - report crosswind
- // 11 - report downwind
- // 12 - report base
- // 13 - report final
- if(code == 1) {
- ground->RequestDeparture(plane, this);
- } else if(code == 2) {
- tower->ContactAtHoldShort(plane, this, CIRCUIT);
- } else if(code == 3) {
- tower->ReportRunwayVacated(plane.callsign);
- } else if(code == 11) {
- tower->ReportDownwind(plane.callsign);
- } else if(code == 13) {
- tower->ReportFinal(plane.callsign);
- } else if(code == 99) { // Flag this instance for deletion
- responseCounter = 0;
- _removeSelf = true;
- SG_LOG(SG_ATC, SG_INFO, "AI local traffic " << plane.callsign << " delete instance callback called.");
- }
-}
-
-void FGAILocalTraffic::ExitRunway(const Point3D& orthopos) {
- //cout << "In ExitRunway" << endl;
- //cout << "Runway ID is " << rwy.ID << endl;
-
- _clearedToLand = false;
-
- node_array_type exitNodes = ground->GetExits(rwy.rwyID); //I suppose we ought to have some fallback for rwy with no defined exits?
- /*
- cout << "Node ID's of exits are ";
- for(unsigned int i=0; i<exitNodes.size(); ++i) {
- cout << exitNodes[i]->nodeID << ' ';
- }
- cout << endl;
- */
- if(exitNodes.size()) {
- //Find the next exit from orthopos.y
- double d;
- double dist = 100000; //ie. longer than any runway in existance
- double backdist = 100000;
- node_array_iterator nItr = exitNodes.begin();
- node* rwyExit = *(exitNodes.begin());
- //int gateID; //This might want to be more persistant at some point
- while(nItr != exitNodes.end()) {
- d = ortho.ConvertToLocal((*nItr)->pos).y() - ortho.ConvertToLocal(_pos).y(); //FIXME - consider making orthopos a class variable
- if(d > 0.0) {
- if(d < dist) {
- dist = d;
- rwyExit = *nItr;
- }
- } else {
- if(fabs(d) < backdist) {
- backdist = d;
- //TODO - need some logic here that if we don't get a forward exit we turn round and store the backwards one
- }
- }
- ++nItr;
- }
- ourGate = ground->GetGateNode();
- if(ourGate == NULL) {
- // Implies no available gates - what shall we do?
- // For now just vanish the plane - possibly we can make this more elegant in the future
- SG_LOG(SG_ATC, SG_ALERT, "No gate found by FGAILocalTraffic whilst landing at " << airportID << '\n');
- //_aip.setVisible(false);
- //cout << "Setting visible false\n";
- operatingState = PARKED;
- return;
- }
- path = ground->GetPath(rwyExit, ourGate);
- /*
- cout << "path returned was:" << endl;
- for(unsigned int i=0; i<path.size(); ++i) {
- switch(path[i]->struct_type) {
- case NODE:
- cout << "NODE " << ((node*)(path[i]))->nodeID << endl;
- break;
- case ARC:
- cout << "ARC\n";
- break;
- }
- }
- */
- taxiState = TD_INBOUND;
- StartTaxi();
- } else {
- // Something must have gone wrong with the ground network file - or there is only a rwy here and no exits defined
- SG_LOG(SG_ATC, SG_INFO, "No exits found by FGAILocalTraffic from runway " << rwy.rwyID << " at " << airportID << '\n');
- //if(airportID == "KRHV") cout << "No exits found by " << plane.callsign << " from runway " << rwy.rwyID << " at " << airportID << '\n';
- // What shall we do - just remove the plane from sight?
- _aip.setVisible(false);
- _invisible = true;
- //cout << "Setting visible false\n";
- //tower->ReportRunwayVacated(plane.callsign);
- string trns = "Clear of the runway ";
- trns += plane.callsign;
- pending_transmission = trns;
- Transmit(3);
- operatingState = PARKED;
- }
-}
-
-// Set the class variable nextTaxiNode to the next node in the path
-// and update taxiPathPos, the class variable path iterator position
-// TODO - maybe should return error codes to the calling function if we fail here
-void FGAILocalTraffic::GetNextTaxiNode() {
- //cout << "GetNextTaxiNode called " << endl;
- //cout << "taxiPathPos = " << taxiPathPos << endl;
- ground_network_path_iterator pathItr = path.begin() + taxiPathPos;
- if(pathItr == path.end()) {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR IN AILocalTraffic::GetNextTaxiNode - no more nodes in path\n");
- } else {
- if((*pathItr)->struct_type == NODE) {
- //cout << "ITS A NODE" << endl;
- //*pathItr = new node;
- nextTaxiNode = (node*)*pathItr;
- ++taxiPathPos;
- //delete pathItr;
- } else {
- //cout << "ITS NOT A NODE" << endl;
- //The first item in found must have been an arc
- //Assume for now that it was straight
- pathItr++;
- taxiPathPos++;
- if(pathItr == path.end()) {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR IN AILocalTraffic::GetNextTaxiNode - path ended with an arc\n");
- } else if((*pathItr)->struct_type == NODE) {
- nextTaxiNode = (node*)*pathItr;
- ++taxiPathPos;
- } else {
- //OOPS - two non-nodes in a row - that shouldn't happen ATM
- SG_LOG(SG_ATC, SG_ALERT, "ERROR IN AILocalTraffic::GetNextTaxiNode - two non-nodes in sequence\n");
- }
- }
- }
-}
-
-// StartTaxi - set up the taxiing state - call only at the start of taxiing
-void FGAILocalTraffic::StartTaxi() {
- //cout << "StartTaxi called" << endl;
- operatingState = TAXIING;
-
- taxiPathPos = 0;
-
- //Set the desired heading
- //Assume we are aiming for first node on path
- //Eventually we may need to consider the fact that we might start on a curved arc and
- //not be able to head directly for the first node.
- GetNextTaxiNode(); // sets the class variable nextTaxiNode to the next taxi node!
- desiredTaxiHeading = GetHeadingFromTo(_pos, nextTaxiNode->pos);
- //cout << "First taxi heading is " << desiredTaxiHeading << endl;
-}
-
-// speed in knots, headings in degrees, radius in meters.
-static double TaxiTurnTowardsHeading(double current_hdg, double desired_hdg, double speed, double radius, double dt) {
- // wrap heading - this prevents a logic bug where the plane would just go round in circles!!
- while(current_hdg < 0.0) {
- current_hdg += 360.0;
- }
- while(current_hdg > 360.0) {
- current_hdg -= 360.0;
- }
- if(fabs(current_hdg - desired_hdg) > 0.1) {
- // Which is the quickest direction to turn onto heading?
- if(desired_hdg > current_hdg) {
- if((desired_hdg - current_hdg) <= 180) {
- // turn right
- current_hdg += ((speed * 0.514444 * dt) / (radius * DCL_PI)) * 180.0;
- // TODO - check that increments are less than the delta that we check for the right direction
- // Probably need to reduce convergence speed as convergence is reached
- } else {
- current_hdg -= ((speed * 0.514444 * dt) / (radius * DCL_PI)) * 180.0;
- }
- } else {
- if((current_hdg - desired_hdg) <= 180) {
- // turn left
- current_hdg -= ((speed * 0.514444 * dt) / (radius * DCL_PI)) * 180.0;
- // TODO - check that increments are less than the delta that we check for the right direction
- // Probably need to reduce convergence speed as convergence is reached
- } else {
- current_hdg += ((speed * 0.514444 * dt) / (radius * DCL_PI)) * 180.0;
- }
- }
- }
- return(current_hdg);
-}
-
-void FGAILocalTraffic::Taxi(double dt) {
- //cout << "Taxi called" << endl;
- // Logic - if we are further away from next point than turn radius then head for it
- // If we have reached turning point then get next point and turn onto that heading
- // Look out for the finish!!
-
- //Point3D orthopos = ortho.ConvertToLocal(pos); // ortho position of the plane
- desiredTaxiHeading = GetHeadingFromTo(_pos, nextTaxiNode->pos);
-
- bool lastNode = (taxiPathPos == path.size() ? true : false);
- if(lastNode) {
- //cout << "LAST NODE\n";
- }
-
- // HACK ALERT! - for now we will taxi at constant speed for straights and turns
-
- // Remember that hdg is always equal to track when taxiing so we don't have to consider them both
- double dist_to_go = dclGetHorizontalSeparation(_pos, nextTaxiNode->pos); // we may be able to do this more cheaply using orthopos
- //cout << "dist_to_go = " << dist_to_go << endl;
- if((nextTaxiNode->type == GATE) && (dist_to_go <= 0.1)) {
- // This might be more robust to outward paths starting with a gate if we check for either
- // last node or TD_INBOUND ?
- // park up
- operatingState = PARKED;
- } else if(((dist_to_go > taxiTurnRadius) || (nextTaxiNode->type == GATE)) && (!liningUp)){
- // if the turn radius is r, and speed is s, then in a time dt we turn through
- // ((s.dt)/(PI.r)) x 180 degrees
- // or alternatively (s.dt)/r radians
- //cout << "hdg = " << hdg << " desired taxi heading = " << desiredTaxiHeading << '\n';
- _hdg = TaxiTurnTowardsHeading(_hdg, desiredTaxiHeading, nominalTaxiSpeed, taxiTurnRadius, dt);
- double vel = nominalTaxiSpeed;
- //cout << "vel = " << vel << endl;
- double dist = vel * 0.514444 * dt;
- //cout << "dist = " << dist << endl;
- double track = _hdg;
- //cout << "track = " << track << endl;
- double slope = 0.0;
- _pos = dclUpdatePosition(_pos, track, slope, dist);
- //cout << "Updated position...\n";
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990) {
- _pos.setelev(_aip.getSGLocation()->get_cur_elev_m() + wheelOffset);
- } // else don't change the elev until we get a valid ground elev again!
- } else if(lastNode) {
- if(taxiState == TD_LINING_UP) {
- if((!liningUp) && (dist_to_go <= taxiTurnRadius)) {
- liningUp = true;
- }
- if(liningUp) {
- _hdg = TaxiTurnTowardsHeading(_hdg, rwy.hdg, nominalTaxiSpeed, taxiTurnRadius, dt);
- double vel = nominalTaxiSpeed;
- //cout << "vel = " << vel << endl;
- double dist = vel * 0.514444 * dt;
- //cout << "dist = " << dist << endl;
- double track = _hdg;
- //cout << "track = " << track << endl;
- double slope = 0.0;
- _pos = dclUpdatePosition(_pos, track, slope, dist);
- //cout << "Updated position...\n";
- if(_aip.getSGLocation()->get_cur_elev_m() > -9990) {
- _pos.setelev(_aip.getSGLocation()->get_cur_elev_m() + wheelOffset);
- } // else don't change the elev until we get a valid ground elev again!
- if(fabs(_hdg - rwy.hdg) <= 1.0) {
- operatingState = IN_PATTERN;
- leg = TAKEOFF_ROLL;
- inAir = false;
- liningUp = false;
- }
- }
- } else if(taxiState == TD_OUTBOUND) {
- // Pause awaiting further instructions
- // and for now assume we've reached the hold-short node
- holdingShort = true;
- } // else at the moment assume TD_INBOUND always ends in a gate in which case we can ignore it
- } else {
- // Time to turn (we've already checked it's not the end we're heading for).
- // set the target node to be the next node which will prompt automatically turning onto
- // the right heading in the stuff above, with the usual provisos applied.
- GetNextTaxiNode();
- // For now why not just recursively call this function?
- Taxi(dt);
- }
-}
-
-
-// Warning - ground elev determination is CPU intensive
-// Either this function or the logic of how often it is called
-// will almost certainly change.
-void FGAILocalTraffic::DoGroundElev() {
- // It would be nice if we could set the correct tile center here in order to get a correct
- // answer with one call to the function, but what I tried in the two commented-out lines
- // below only intermittently worked, and I haven't quite groked why yet.
- //SGBucket buck(pos.lon(), pos.lat());
- //aip.getSGLocation()->set_tile_center(Point3D(buck.get_center_lon(), buck.get_center_lat(), 0.0));
-
- // Only do the proper hitlist stuff if we are within visible range of the viewer.
- double visibility_meters = fgGetDouble("/environment/visibility-m");
- FGViewer* vw = globals->get_current_view();
- if(dclGetHorizontalSeparation(_pos, Point3D(vw->getLongitude_deg(), vw->getLatitude_deg(), 0.0)) > visibility_meters) {
- _aip.getSGLocation()->set_cur_elev_m(aptElev);
- return;
- }
-
- // FIXME: make shure the pos.lat/pos.lon values are in degrees ...
- double range = 500.0;
- double lat = _aip.getSGLocation()->getLatitude_deg();
- double lon = _aip.getSGLocation()->getLongitude_deg();
- if (!globals->get_tile_mgr()->scenery_available(lat, lon, range)) {
- // Try to shedule tiles for that position.
- globals->get_tile_mgr()->update( _aip.getSGLocation(), range );
- }
-
- // FIXME: make shure the pos.lat/pos.lon values are in degrees ...
- double alt;
- if (globals->get_scenery()->get_elevation_m(lat, lon, 20000.0, alt, 0))
- _aip.getSGLocation()->set_cur_elev_m(alt);
-}
-
+++ /dev/null
-// FGAILocalTraffic - AIEntity derived class with enough logic to
-// fly and interact with the traffic pattern.
-//
-// Written 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.
-
-#ifndef _FG_AILocalTraffic_HXX
-#define _FG_AILocalTraffic_HXX
-
-#include <simgear/math/point3d.hxx>
-#include <Main/fg_props.hxx>
-
-#include "AIPlane.hxx"
-#include "ATCProjection.hxx"
-#include "ground.hxx"
-
-class FGGround;
-class FGTower;
-struct Gate;
-
-#include <string>
-SG_USING_STD(string);
-
-enum TaxiState {
- TD_INBOUND,
- TD_OUTBOUND,
- TD_NONE,
- TD_LINING_UP
-};
-
-enum OperatingState {
- IN_PATTERN,
- TAXIING,
- PARKED,
- EN_ROUTE
-};
-
-struct StartOfDescent {
- PatternLeg leg;
- double x; // Runway aligned orthopos
- double y; // ditto
-};
-
-class FGAILocalTraffic : public FGAIPlane {
-
-public:
-
- // At the moment we expect the expanded short form callsign - eventually we will just want the reg + type.
- FGAILocalTraffic();
- ~FGAILocalTraffic();
-
- // Initialise
- bool Init(const string& callsign, const string& ICAO, OperatingState initialState = PARKED, PatternLeg initialLeg = DOWNWIND);
-
- // Run the internal calculations
- void Update(double dt);
-
- // Go out and practice circuits
- void FlyCircuits(int numCircuits, bool tag);
-
- // Return what type of landing we're doing on this circuit
- LandingType GetLandingOption();
-
- // TODO - this will get more complex and moved into the main class
- // body eventually since the position approved to taxi to will have
- // to be passed.
- inline void ApproveTaxiRequest() {taxiRequestCleared = true;}
-
- inline void DenyTaxiRequest() {taxiRequestCleared = false;}
-
- void RegisterTransmission(int code);
-
- // Process callbacks sent by base class
- // (These codes are not related to the codes above)
- void ProcessCallback(int code);
-
- // This is a hack and will probably go eventually
- inline bool AtHoldShort() {return holdingShort;}
-
-protected:
-
- // Attempt to enter the traffic pattern in a reasonably intelligent manner
- void EnterTrafficPattern(double dt);
-
- // Set up the internal state to be consistent for a downwind entry.
- void DownwindEntry();
-
- // Ditto for straight-in
- void StraightInEntry(bool des = false);
-
- // Do what is necessary to land and parkup at home airport
- void ReturnToBase(double dt);
-
- // Airport/runway/pattern details
- string airportID; // The ICAO code of the airport that we're operating around
- double aptElev; // Airport elevation
- FGGround* ground; // A pointer to the ground control.
- FGTower* tower; // A pointer to the tower control.
- bool _controlled; // Set true if we find tower control working for the airport, false otherwise.
- RunwayDetails rwy;
- double patternDirection; // 1 for right, -1 for left (This is double because we multiply/divide turn rates
- // with it to get RH/LH turns - DON'T convert it to int under ANY circumstances!!
- double glideAngle; // Assumed to be visual glidepath angle for FGAILocalTraffic - can be found at www.airnav.com
- // Its conceivable that patternDirection and glidePath could be moved into the RunwayDetails structure.
-
- // Its possible that this might be moved out to the ground/airport class at some point.
- FGATCAlignedProjection ortho; // Orthogonal mapping of the local area with the threshold at the origin
- // and the runway aligned with the y axis.
-
- void GetAirportDetails(const string& id);
-
- void GetRwyDetails(const string& id);
-
- double responseCounter; // timer in seconds to allow response to requests to be a little while after them
- // Will almost certainly get moved to FGAIPlane.
-
-private:
- FGATCMgr* ATC;
- // This is purely for synactic convienience to avoid writing globals->get_ATC_mgr()-> all through the code!
-
- // High-level stuff
- OperatingState operatingState;
- int circuitsToFly; //Number of circuits still to do in this session NOT INCLUDING THE CURRENT ONE
- bool touchAndGo; //True if circuits should be flown touch and go, false for full stop
- bool transmitted; // Set true when a position report for the current leg has been transmitted.
-
- // Performance characteristics of the plane in knots and ft/min - some of this might get moved out into FGAIPlane
- double Vr;
- double best_rate_of_climb_speed;
- double best_rate_of_climb;
- double nominal_climb_speed;
- double nominal_climb_rate;
- double nominal_circuit_speed;
- double min_circuit_speed;
- double max_circuit_speed;
- double nominal_descent_rate;
- double nominal_approach_speed;
- double nominal_final_speed;
- double stall_speed_landing_config;
- double nominal_taxi_speed;
-
- // Physical/rendering stuff
- double wheelOffset; // Height above ground at which we need to render the plane whilst taxiing
- bool elevInitGood; // We have had at least one good elev reading
- bool inAir; // True when off the ground
-
- // environment - some of this might get moved into FGAIPlane
- SGPropertyNode_ptr wind_from_hdg; //degrees
- SGPropertyNode_ptr wind_speed_knots; //knots
-
- // Pattern details that (may) change
- int numInPattern; // Number of planes in the pattern (this might get more complicated if high performance GA aircraft fly a higher pattern eventually)
- int numAhead; // More importantly - how many of them are ahead of us?
- double distToNext; // And even more importantly, how near are we getting to the one immediately ahead?
- //PatternLeg leg; // Our current position in the pattern - now moved to FGAIPlane
- StartOfDescent SoD; // Start of descent calculated wrt wind, pattern size & altitude, glideslope etc
- bool descending; // We're in the coming down phase of the pattern
- double targetDescentRate; // m/s
-
- // Taxiing details
- // At the moment this assumes that all taxiing in is to gates (a loose term that includes
- // any permitted parking spot) and that all taxiing out is to runways.
- bool parked;
- bool taxiing;
- bool taxiRequestPending;
- bool taxiRequestCleared;
- TaxiState taxiState;
- double desiredTaxiHeading;
- double taxiTurnRadius;
- double nominalTaxiSpeed;
- Gate* ourGate;
- ground_network_path_type path; // a path through the ground network for the plane to taxi
- unsigned int taxiPathPos; // position of iterator in taxi path when applicable
- node* nextTaxiNode; // next node in taxi path
- node* holdShortNode;
- //Runway out_dest; //FIXME - implement this
- bool holdingShort;
- bool reportReadyForDeparture; // set true when ATC has requested that the plane report when ready for departure
- bool clearedToLineUp;
- bool clearedToTakeOff;
- bool _clearedToLand; // also implies cleared for the option.
- bool liningUp; // Set true when the turn onto the runway heading is commenced when taxiing out
- bool goAround; // Set true if need to go-around
- bool goAroundCalled; // Set true during go-around only after we have called our go-around on the radio
- bool contactTower; // we have been told to contact tower
- bool contactGround; // we have been told to contact ground
- bool changeFreq; // true when we need to change frequency
- bool _taxiToGA; // Temporary mega-hack indicating we are to taxi to the GA parking and disconnect from tower control.
- bool _removeSelf; // Indicates that we wish to remove this instance. The use of a variable is a hack to allow time for messages to purge before removal, due to the fagility of the current dialog system.
- atc_type changeFreqType; // the service we need to change to
- bool freeTaxi; // False if the airport has a facilities file with a logical taxi network defined, true if we need to calculate our own taxiing points.
-
- // Hack for getting close to the runway when atan can go pear-shaped
- double _savedSlope;
-
- void FlyTrafficPattern(double dt);
-
- // TODO - need to add something to define what option we are flying - Touch and go / Stop and go / Landing properly / others?
-
- void TransmitPatternPositionReport();
-
- void CalculateSoD(double base_leg_pos, double downwind_leg_pos, bool pattern_direction);
-
- void ExitRunway(const Point3D& orthopos);
-
- void StartTaxi();
-
- void Taxi(double dt);
-
- void GetNextTaxiNode();
-
- void DoGroundElev();
-
- // Set when the plane should be invisible *regardless of distance from user*.
- bool _invisible;
-};
-
-#endif // _FG_AILocalTraffic_HXX
+++ /dev/null
-// AIMgr.cxx - implementation of FGAIMgr
-// - a global management class for FlightGear generated AI traffic
-//
-// Written 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 <Main/fg_props.hxx>
-#include <Main/globals.hxx>
-#include <simgear/misc/sg_path.hxx>
-#include <simgear/math/sg_random.h>
-#include <simgear/scene/model/modellib.hxx>
-#include <list>
-
-#ifdef _MSC_VER
-# include <io.h>
-#else
-# include <sys/types.h> // for directory reading
-# include <dirent.h> // for directory reading
-#endif
-
-#include <Environment/environment_mgr.hxx>
-#include <Environment/environment.hxx>
-
-#include "AIMgr.hxx"
-#include "AILocalTraffic.hxx"
-#include "AIGAVFRTraffic.hxx"
-#include "ATCutils.hxx"
-#include "commlist.hxx"
-
-SG_USING_STD(list);
-SG_USING_STD(cout);
-
-using namespace simgear;
-
-FGAIMgr::FGAIMgr() {
- ATC = globals->get_ATC_mgr();
- initDone = false;
- ai_callsigns_used["GFS"] = 1; // so we don't inadvertently use this
- // TODO - use the proper user callsign when it becomes user settable.
- removalList.clear();
- activated.clear();
- _havePiperModel = true;
-}
-
-FGAIMgr::~FGAIMgr() {
- for (ai_list_itr = ai_list.begin(); ai_list_itr != ai_list.end(); ai_list_itr++) {
- delete (*ai_list_itr);
- }
-}
-
-void FGAIMgr::init() {
- //cout << "AIMgr::init called..." << endl;
-
- // Pointers to user's position
- lon_node = fgGetNode("/position/longitude-deg", true);
- lat_node = fgGetNode("/position/latitude-deg", true);
- elev_node = fgGetNode("/position/altitude-ft", true);
-
- lon = lon_node->getDoubleValue();
- lat = lat_node->getDoubleValue();
- elev = elev_node->getDoubleValue();
-
- // Load up models at the start to avoid pausing later
- // Hack alert - Hardwired paths!!
- string planepath = "Aircraft/c172p/Models/c172p.xml";
- bool _loadedDefaultOK = true;
- try {
- _defaultModel = SGModelLib::loadPagedModel(planepath.c_str(), globals->get_props());
- } catch(sg_exception&) {
- _loadedDefaultOK = false;
- }
-
- if(!_loadedDefaultOK ) {
- // Just load the same 3D model as the default user plane - that's *bound* to exist!
- // TODO - implement robust determination of availability of GA AI aircraft models
- planepath = "Aircraft/c172p/Models/c172p.ac";
- _defaultModel = SGModelLib::loadPagedModel(planepath.c_str(), globals->get_props());
- }
-
- planepath = "Aircraft/pa28-161/Models/pa28-161.ac";
- try {
- _piperModel = SGModelLib::loadPagedModel(planepath.c_str(), globals->get_props());
- } catch(sg_exception&) {
- _havePiperModel = false;
- }
-
- // go through the $FG_ROOT/ATC directory and find all *.taxi files
- SGPath path(globals->get_fg_root());
- path.append("ATC/");
- string dir = path.dir();
- string ext;
- string file, f_ident;
- int pos;
-
- ulDir *d;
- struct ulDirEnt *de;
-
- if ( (d = ulOpenDir( dir.c_str() )) == NULL ) {
- SG_LOG(SG_ATC, SG_WARN, "cannot open directory " << dir);
- } else {
- // load all .taxi files
- while ( (de = ulReadDir(d)) != NULL ) {
- file = de->d_name;
- pos = file.find(".");
- ext = file.substr(pos + 1);
- if(ext == "taxi") {
- f_ident = file.substr(0, pos);
- const FGAirport *a = fgFindAirportID( f_ident);
- if(a){
- SGBucket sgb(a->getLongitude(), a->getLatitude());
- int idx = sgb.gen_index();
- if(facilities.find(idx) != facilities.end()) {
- facilities[idx]->push_back(f_ident);
- } else {
- ID_list_type* apts = new ID_list_type;
- apts->push_back(f_ident);
- facilities[idx] = apts;
- }
- SG_LOG(SG_ATC, SG_BULK, "Mapping " << f_ident << " to bucket " << idx);
- }
- }
- }
- ulCloseDir(d);
- }
-
- // See if are in range at startup and activate if necessary
- SearchByPos(15.0);
-
- initDone = true;
-
- //cout << "AIMgr::init done..." << endl;
-
- /*
- // TESTING
- FGATCAlignedProjection ortho;
- ortho.Init(fgGetAirportPos("KEMT"), 205.0); // Guess of rwy19 heading
- //Point3D ip = ortho.ConvertFromLocal(Point3D(6000, 1000, 1000)); // 90 deg entry
- //Point3D ip = ortho.ConvertFromLocal(Point3D(-7000, 3000, 1000)); // 45 deg entry
- Point3D ip = ortho.ConvertFromLocal(Point3D(1000, -7000, 1000)); // straight-in
- ATC->AIRegisterAirport("KEMT");
- FGAIGAVFRTraffic* p = new FGAIGAVFRTraffic();
- p->SetModel(_defaultModel);
- p->Init(ip, "KEMT", GenerateShortForm(GenerateUniqueCallsign()));
- ai_list.push_back(p);
- traffic[ident].push_back(p);
- activated["KEMT"] = 1;
- */
-}
-
-void FGAIMgr::bind() {
-}
-
-void FGAIMgr::unbind() {
-}
-
-void FGAIMgr::update(double dt) {
- if(!initDone) {
- init();
- SG_LOG(SG_ATC, SG_WARN, "Warning - AIMgr::update(...) called before AIMgr::init()");
- }
-
- //cout << activated.size() << '\n';
-
- Point3D userPos = Point3D(lon_node->getDoubleValue(), lat_node->getDoubleValue(), elev_node->getDoubleValue());
-
- // TODO - make these class variables!!
- static int i = 0;
- static int j = 0;
-
- // Don't update any planes for first 50 runs through - this avoids some possible initialisation anomalies
- // Might not need it now we have fade-in though?
- if(i < 50) {
- ++i;
- return;
- }
-
- if(j == 215) {
- SearchByPos(25.0);
- j = 0;
- } else if(j == 200) {
- // Go through the list of activated airports and remove those out of range
- //cout << "The following airports have been activated by the AI system:\n";
- ai_activated_map_iterator apt_itr = activated.begin();
- while(apt_itr != activated.end()) {
- //cout << "FIRST IS " << (*apt_itr).first << '\n';
- if(dclGetHorizontalSeparation(userPos, fgGetAirportPos((*apt_itr).first)) > (35.0 * 1600.0)) {
- // Then get rid of it and make sure the iterator is left pointing to the next one!
- string s = (*apt_itr).first;
- if(traffic.find(s) != traffic.end()) {
- //cout << "s = " << s << ", traffic[s].size() = " << traffic[s].size() << '\n';
- if(!traffic[s].empty()) {
- apt_itr++;
- } else {
- //cout << "Erasing " << (*apt_itr).first << " and traffic" << '\n';
- activated.erase(apt_itr);
- apt_itr = activated.upper_bound(s);
- traffic.erase(s);
- }
- } else {
- //cout << "Erasing " << (*apt_itr).first << ' ' << (*apt_itr).second << '\n';
- activated.erase(apt_itr);
- apt_itr = activated.upper_bound(s);
- }
- } else {
- apt_itr++;
- }
- }
- } else if(j == 180) {
- // Go through the list of activated airports and do the random airplane generation
- ai_traffic_map_iterator it = traffic.begin();
- while(it != traffic.end()) {
- string s = (*it).first;
- //cout << "s = " << s << " size = " << (*it).second.size() << '\n';
- // Only generate extra traffic if within a certain distance of the user,
- // TODO - maybe take users's tuned freq into account as well.
- double d = dclGetHorizontalSeparation(userPos, fgGetAirportPos(s));
- if(d < (15.0 * 1600.0)) {
- double cd = 0.0;
- bool gen = false;
- //cout << "Size of list is " << (*it).second.size() << " at " << s << '\n';
- if((*it).second.size()) {
- FGAIEntity* e = *((*it).second.rbegin()); // Get the last airplane currently scheduled to arrive at this airport.
- cd = dclGetHorizontalSeparation(e->GetPos(), fgGetAirportPos(s));
- if(cd < (d < 5000 ? 10000 : d + 5000)) {
- gen = true;
- }
- } else {
- gen = true;
- cd = 0.0;
- }
- if(gen) {
- //cout << "Generating extra traffic at airport " << s << ", at least " << cd << " meters out\n";
- //GenerateSimpleAirportTraffic(s, cd);
- GenerateSimpleAirportTraffic(s, cd + 3000.0); // The random seems a bit wierd - traffic could get far too bunched without the +3000.
- // TODO - make the anti-random constant variable depending on the ai-traffic level.
- }
- }
- ++it;
- }
- }
-
- ++j;
-
- //cout << "Size of AI list is " << ai_list.size() << '\n';
-
- // TODO - need to add a check of if any activated airports have gone out of range
-
- string rs; // plane to be removed, if one.
- if(removalList.size()) {
- rs = *(removalList.begin());
- removalList.pop_front();
- } else {
- rs = "";
- }
-
- // Traverse the list of active planes and run all their update methods
- // TODO - spread the load - not all planes should need updating every frame.
- // Note that this will require dt to be calculated for each plane though
- // since they rely on it to calculate distance travelled.
- ai_list_itr = ai_list.begin();
- while(ai_list_itr != ai_list.end()) {
- FGAIEntity *e = *ai_list_itr;
- if(rs.size() && e->GetCallsign() == rs) {
- //cout << "Removing " << rs << " from ai_list\n";
- ai_list_itr = ai_list.erase(ai_list_itr);
- delete e;
- // This is a hack - we should deref this plane from the airport count!
- } else {
- e->Update(dt);
- ++ai_list_itr;
- }
- }
-
- //cout << "Size of AI list is " << ai_list.size() << '\n';
-}
-
-void FGAIMgr::ScheduleRemoval(const string& s) {
- //cout << "Scheduling removal of plane " << s << " from AIMgr\n";
- removalList.push_back(s);
-}
-
-// Activate AI traffic at an airport
-void FGAIMgr::ActivateAirport(const string& ident) {
- ATC->AIRegisterAirport(ident);
- // TODO - need to start the traffic more randomly
- FGAILocalTraffic* local_traffic = new FGAILocalTraffic;
- local_traffic->SetModel(_defaultModel.get()); // currently hardwired to cessna.
- //local_traffic->Init(ident, IN_PATTERN, TAKEOFF_ROLL);
- local_traffic->Init(GenerateShortForm(GenerateUniqueCallsign()), ident);
- local_traffic->FlyCircuits(1, true); // Fly 2 circuits with touch & go in between
- ai_list.push_back(local_traffic);
- traffic[ident].push_back(local_traffic);
- //cout << "******** ACTIVATING AIRPORT, ident = " << ident << '\n';
- activated[ident] = 1;
-}
-
-// Hack - Generate AI traffic at an airport with no facilities file
-void FGAIMgr::GenerateSimpleAirportTraffic(const string& ident, double min_dist) {
- // Ugly hack - don't let VFR Cessnas operate at a hardwired list of major airports
- // This will go eventually once airport .xml files specify the traffic profile
- if(ident == "KSFO" || ident == "KDFW" || ident == "EGLL" || ident == "KORD" || ident == "KJFK"
- || ident == "KMSP" || ident == "KLAX" || ident == "KBOS" || ident == "KEDW"
- || ident == "KSEA" || ident == "EHAM") {
- return;
- }
-
- /*
- // TODO - check for military airports - this should be in the current data.
- // UGGH - there's no point at the moment - everything is labelled civil in basic.dat!
- FGAirport a = fgFindAirportID(ident, &a);
- if(a) {
- cout << "CODE IS " << a.code << '\n';
- } else {
- // UG - can't find the airport!
- return;
- }
- */
-
- Point3D aptpos = fgGetAirportPos(ident); // TODO - check for elev of -9999
- //cout << "ident = " << ident << ", elev = " << aptpos.elev() << '\n';
-
- // Operate from airports at 3000ft and below only to avoid the default cloud layers and since we don't degrade AI performance with altitude.
- if(aptpos.elev() > 3000) {
- //cout << "High alt airports not yet supported - returning\n";
- return;
- }
-
- // Rough hack for plane type - make 70% of the planes cessnas, the rest pipers.
- bool cessna = true;
-
- // Get the time and only operate VFR in the (approximate) daytime.
- struct tm *t = globals->get_time_params()->getGmt();
- int loc_time = t->tm_hour + int(aptpos.lon() / (360.0 / 24.0));
- while (loc_time < 0)
- loc_time += 24;
- while (loc_time >= 24)
- loc_time -= 24;
-
- //cout << "loc_time = " << loc_time << '\n';
- if(loc_time < 7 || loc_time > 19) return;
-
- // Check that the visibility is OK for IFR operation.
- double visibility;
- FGEnvironment stationweather =
- ((FGEnvironmentMgr *)globals->get_subsystem("environment"))
- ->getEnvironment(aptpos.lat(), aptpos.lon(), aptpos.elev()); // TODO - check whether this should take ft or m for elev.
- visibility = stationweather.get_visibility_m();
- // Technically we can do VFR down to 1 mile (1600m) but that's pretty murky!
- //cout << "vis = " << visibility << '\n';
- if(visibility < 3000) return;
-
- ATC->AIRegisterAirport(ident);
-
- // Next - get the distance from user to the airport.
- Point3D userpos = Point3D(lon_node->getDoubleValue(), lat_node->getDoubleValue(), elev_node->getDoubleValue());
- double d = dclGetHorizontalSeparation(userpos, aptpos); // in meters
-
- int lev = fgGetInt("/sim/ai-traffic/level");
- if(lev < 1)
- return;
- if (lev > 3)
- lev = 3;
- if(visibility < 6000) lev = 1;
- //cout << "level = " << lev << '\n';
-
- // Next - generate any local / circuit traffic
-
- /*
- // --------------------------- THIS BLOCK IS JUST FOR TESTING - COMMENT OUT BEFORE RELEASE ---------------
- // Finally - generate VFR approaching traffic
- //if(d > 2000) {
- if(ident == "KPOC") {
- double ad = 2000.0;
- double avd = 3000.0; // average spacing of arriving traffic in meters - relate to airport business and AI density setting one day!
- //while(ad < (d < 10000 ? 12000 : d + 2000)) {
- for(int i=0; i<8; ++i) {
- double dd = sg_random() * avd;
- // put a minimum spacing in for now since I don't think tower will cope otherwise!
- if(dd < 1500) dd = 1500;
- //ad += dd;
- ad += dd;
- double dir = int(sg_random() * 36);
- if(dir == 36) dir--;
- dir *= 10;
- //dir = 180;
- if(sg_random() < 0.3) cessna = false;
- else cessna = true;
- string s = GenerateShortForm(GenerateUniqueCallsign(), (cessna ? "Cessna-" : "Piper-"));
- FGAIGAVFRTraffic* t = new FGAIGAVFRTraffic();
- t->SetModel(cessna ? _defaultModel : _piperModel);
- //cout << "Generating VFR traffic " << s << " inbound to " << ident << " " << ad << " meters out from " << dir << " degrees\n";
- Point3D tpos = dclUpdatePosition(aptpos, dir, 6.0, ad);
- if(tpos.elev() > (aptpos.elev() + 3000.0)) tpos.setelev(aptpos.elev() + 3000.0);
- t->Init(tpos, ident, s);
- ai_list.push_back(t);
- }
- }
- activated[ident] = 1;
- return;
- //---------------------------------------------------------------------------------------------------
- */
-
- double ad; // Minimum distance out of first arriving plane in meters.
- double mind; // Minimum spacing of traffic in meters
- double avd; // average spacing of arriving traffic in meters - relate to airport business and AI density setting one day!
- // Finally - generate VFR approaching traffic
- //if(d > 2000) {
- if(1) {
- if(lev == 3) {
- ad = 5000.0;
- mind = 2000.0;
- avd = 6000.0;
- } else if(lev == 2) {
- ad = 8000.0;
- mind = 4000.0;
- avd = 10000.0;
- } else {
- ad = 9000.0; // Start the first aircraft at least 9K out for now.
- mind = 6000.0;
- avd = 15000.0;
- }
- /*
- // Check if there is already arriving traffic at this airport
- cout << "BING A " << ident << '\n';
- if(traffic.find(ident) != traffic.end()) {
- cout << "BING B " << ident << '\n';
- ai_list_type lst = traffic[ident];
- cout << "BING C " << ident << '\n';
- if(lst.size()) {
- cout << "BING D " << ident << '\n';
- double cd = dclGetHorizontalSeparation(aptpos, (*lst.rbegin())->GetPos());
- cout << "ident = " << ident << ", cd = " << cd << '\n';
- if(cd > ad) ad = cd;
- }
- }
- */
- if(min_dist != 0) ad = min_dist;
- //cout << "ident = " << ident << ", ad = " << ad << '\n';
- while(ad < (d < 5000 ? 15000 : d + 10000)) {
- double dd = mind + (sg_random() * (avd - mind));
- ad += dd;
- double dir = int(sg_random() * 36);
- if(dir == 36) dir--;
- dir *= 10;
-
- if(sg_random() < 0.3) cessna = false;
- else cessna = true;
- string s = GenerateShortForm(GenerateUniqueCallsign(), (cessna ? "Cessna-" : "Piper-"));
- FGAIGAVFRTraffic* t = new FGAIGAVFRTraffic();
- t->SetModel(cessna ? _defaultModel.get() : (_havePiperModel ? _piperModel.get() : _defaultModel.get()));
- //cout << "Generating VFR traffic " << s << " inbound to " << ident << " " << ad << " meters out from " << dir << " degrees\n";
- Point3D tpos = dclUpdatePosition(aptpos, dir, 6.0, ad);
- if(tpos.elev() > (aptpos.elev() + 3000.0)) tpos.setelev(aptpos.elev() + 3000.0); // FEET yuk :-(
- t->Init(tpos, ident, s);
- ai_list.push_back(t);
- traffic[ident].push_back(t);
- }
- }
-}
-
-/*
-// Generate a VFR arrival at airport apt, at least distance d (meters) out.
-void FGAIMgr::GenerateVFRArrival(const string& apt, double d) {
-}
-*/
-
-// Search for valid airports in the vicinity of the user and activate them if necessary
-void FGAIMgr::SearchByPos(double range) {
- //cout << "In SearchByPos(...)" << endl;
-
- // get bucket number for plane position
- lon = lon_node->getDoubleValue();
- lat = lat_node->getDoubleValue();
- elev = elev_node->getDoubleValue() * SG_FEET_TO_METER;
- SGBucket buck(lon, lat);
-
- // get neigboring buckets
- int bx = (int)( range*SG_NM_TO_METER / buck.get_width_m() / 2);
- //cout << "bx = " << bx << endl;
- int by = (int)( range*SG_NM_TO_METER / buck.get_height_m() / 2 );
- //cout << "by = " << by << endl;
-
- // Search for airports with facitities files --------------------------
- // loop over bucket range
- for ( int i=-bx; i<=bx; i++) {
- //cout << "i loop\n";
- for ( int j=-by; j<=by; j++) {
- //cout << "j loop\n";
- buck = sgBucketOffset(lon, lat, i, j);
- long int bucket = buck.gen_index();
- //cout << "bucket is " << bucket << endl;
- if(facilities.find(bucket) != facilities.end()) {
- ID_list_type* apts = facilities[bucket];
- ID_list_iterator current = apts->begin();
- ID_list_iterator last = apts->end();
-
- //cout << "Size of apts is " << apts->size() << endl;
-
- //double rlon = lon * SGD_DEGREES_TO_RADIANS;
- //double rlat = lat * SGD_DEGREES_TO_RADIANS;
- //Point3D aircraft = sgGeodToCart( Point3D(rlon, rlat, elev) );
- //Point3D airport;
- for(; current != last; ++current) {
- //cout << "Found " << *current << endl;;
- if(activated.find(*current) == activated.end()) {
- //cout << "Activating " << *current << endl;
- //FGAirport a;
- //if(dclFindAirportID(*current, &a)) {
- // // We can do something here based on distance from the user if we wish.
- //}
- //string s = *current;
- //cout << "s = " << s << '\n';
- ActivateAirport(*current);
- //ActivateSimpleAirport(*current); // TODO - put this back to ActivateAirport when that code is done.
- //cout << "Activation done" << endl;
- } else {
- //cout << *current << " already activated" << endl;
- }
- }
- }
- }
- }
- //-------------------------------------------------------------
-
- // Search for any towered airports in the vicinity ------------
- comm_list_type towered;
- comm_list_iterator twd_itr;
-
- int num_twd = current_commlist->FindByPos(lon, lat, elev, range, &towered, TOWER);
- if (num_twd != 0) {
- double closest = 1000000;
- string s = "";
- for(twd_itr = towered.begin(); twd_itr != towered.end(); twd_itr++) {
- // Only activate the closest airport not already activated each time.
- if(activated.find(twd_itr->ident) == activated.end()) {
- double sep = dclGetHorizontalSeparation(Point3D(lon, lat, elev), fgGetAirportPos(twd_itr->ident));
- if(sep < closest) {
- closest = sep;
- s = twd_itr->ident;
- }
-
- }
- }
- if(s.size()) {
- // TODO - find out why empty strings come through here when all in-range airports done.
- GenerateSimpleAirportTraffic(s);
- //cout << "**************ACTIVATING SIMPLE AIRPORT, ident = " << s << '\n';
- activated[s] = 1;
- }
- }
-}
-
-string FGAIMgr::GenerateCallsign() {
- // For now we'll just generate US callsigns until we can regionally identify airports.
- string s = "N";
- // Add 3 to 5 numbers and make up to 5 with letters.
- //sg_srandom_time();
- double d = sg_random();
- int n = int(d * 3);
- if(n == 3) --n;
- //cout << "First n, n = " << n << '\n';
- int j = 3 + n;
- //cout << "j = " << j << '\n';
- for(int i=0; i<j; ++i) {
- int n = int(sg_random() * 10);
- if(n == 10) --n;
- s += (char)('0' + n);
- }
- for(int i=j; i<5; ++i) {
- int n = int(sg_random() * 26);
- if(n == 26) --n;
- //cout << "Alpha, n = " << n << '\n';
- s += (char)('A' + n);
- }
- //cout << "s = " << s << '\n';
- return(s);
-}
-
-string FGAIMgr::GenerateUniqueCallsign() {
- while(1) {
- string s = GenerateCallsign();
- if(!ai_callsigns_used[s]) {
- ai_callsigns_used[s] = 1;
- return(s);
- }
- }
-}
-
-// This will be moved somewhere else eventually!!!!
-string FGAIMgr::GenerateShortForm(const string& callsign, const string& plane_str, bool local) {
- //cout << callsign << '\n';
- string s;
- if(local) s = "Trainer-";
- else s = plane_str;
- for(int i=3; i>0; --i) {
- char c = callsign[callsign.size() - i];
- //cout << c << '\n';
- string tmp = "";
- tmp += c;
- if(isalpha(c)) s += GetPhoneticIdent(c);
- else s += ConvertNumToSpokenDigits(tmp);
- if(i > 1) s += '-';
- }
- return(s);
-}
+++ /dev/null
-// AIMgr.hxx - definition of FGAIMgr
-// - a global management class for FlightGear generated AI traffic
-//
-// Written 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.
-
-#ifndef _FG_AIMGR_HXX
-#define _FG_AIMGR_HXX
-
-#include <simgear/structure/subsystem_mgr.hxx>
-
-#include <Main/fg_props.hxx>
-
-#include <list>
-
-#include "ATCmgr.hxx"
-#include "AIEntity.hxx"
-
-SG_USING_STD(list);
-
-
-class FGAIMgr : public SGSubsystem
-{
-
-private:
- FGATCMgr* ATC;
- // This is purely for synactic convienience to avoid writing globals->get_ATC_mgr()-> all through the code!
-
- // A list of pointers to all currently active AI stuff
- typedef list <FGAIEntity*> ai_list_type;
- typedef ai_list_type::iterator ai_list_iterator;
- typedef ai_list_type::const_iterator ai_list_const_iterator;
-
- // Everything put in this list should be created dynamically
- // on the heap and ***DELETED WHEN REMOVED!!!!!***
- ai_list_type ai_list;
- ai_list_iterator ai_list_itr;
- // Any member function of FGATCMgr is permitted to leave this iterator pointing
- // at any point in or at the end of the list.
- // Hence any new access must explicitly first check for atc_list.end() before dereferencing.
-
- // A list of airport or airplane ID's
- typedef list < string > ID_list_type;
- typedef ID_list_type::iterator ID_list_iterator;
-
- // Temporary storage of ID of planes scheduled for removeal
- ID_list_type removalList;
-
- // A map of airport-IDs that have taxiway network files against bucket number
- typedef map < int, ID_list_type* > ai_apt_map_type;
- typedef ai_apt_map_type::iterator ai_apt_map_iterator;
- ai_apt_map_type facilities;
-
- // A map of airport ID's that we've activated AI traffic at
- typedef map < string, int > ai_activated_map_type;
- typedef ai_activated_map_type::iterator ai_activated_map_iterator;
- ai_activated_map_type activated;
-
- // AI traffic lists mapped by airport
- typedef map < string, ai_list_type > ai_traffic_map_type;
- typedef ai_traffic_map_type::iterator ai_traffic_map_iterator;
- ai_traffic_map_type traffic;
-
- // A map of callsigns that we have used (eg CFGFS or N0546D - the code will generate Cessna-four-six-delta from this later)
- typedef map < string, int > ai_callsigns_map_type;
- typedef ai_callsigns_map_type::iterator ai_callsigns_map_iterator;
- ai_callsigns_map_type ai_callsigns_used;
-
- // Position of the Users Aircraft
- double lon;
- double lat;
- double elev;
- // Pointers to current users position
- SGPropertyNode_ptr lon_node;
- SGPropertyNode_ptr lat_node;
- SGPropertyNode_ptr elev_node;
-
-public:
-
- FGAIMgr();
- ~FGAIMgr();
-
- void init();
-
- void bind();
-
- void unbind();
-
- void update(double dt);
-
- // Signal that it is OK to remove a plane of callsign s
- // (To be called by the plane itself).
- void ScheduleRemoval(const string& s);
-
-private:
-
- osg::ref_ptr<osg::Node> _defaultModel; // Cessna 172!
- osg::ref_ptr<osg::Node> _piperModel; // pa28-161
-
- bool initDone; // Hack - guard against update getting called before init
-
- // Remove a class from the ai_list and delete it from memory
- //void RemoveFromList(const char* id, atc_type tp);
-
- // Activate AI traffic at an airport
- void ActivateAirport(const string& ident);
-
- // Hack - Generate AI traffic at an airport with no facilities file, with the first plane being at least min_dist out.
- void GenerateSimpleAirportTraffic(const string& ident, double min_dist = 0.0);
-
- // Search for valid airports in the vicinity of the user and activate them if necessary
- void SearchByPos(double range);
-
- string GenerateCallsign();
-
- string GenerateUniqueCallsign();
-
- string GenerateShortForm(const string& callsign, const string& plane_str = "Cessna-", bool local = false);
-
- // TODO - implement a proper robust system for registering and loading AI GA aircraft models
- bool _havePiperModel;
-};
-
-#endif // _FG_AIMGR_HXX
+++ /dev/null
-// FGAIPlane - abstract base class for an AI plane
-//
-// Written by David Luff, started 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.
-
-#include <Main/globals.hxx>
-#include <Main/fg_props.hxx>
-#include <simgear/math/point3d.hxx>
-#include <simgear/debug/logstream.hxx>
-#include <simgear/sound/soundmgr_openal.hxx>
-#include <math.h>
-#include <string>
-SG_USING_STD(string);
-
-
-#include "AIPlane.hxx"
-
-FGAIPlane::FGAIPlane() {
- leg = LEG_UNKNOWN;
- tuned_station = NULL;
- pending_transmission = "";
- _timeout = 0;
- _pending = false;
- _callback_code = 0;
- _transmit = false;
- _transmitting = false;
- voice = false;
- playing = false;
- voiceOK = false;
- vPtr = NULL;
- track = 0.0;
- _tgtTrack = 0.0;
- _trackSet = false;
- _tgtRoll = 0.0;
- _rollSuspended = false;
-}
-
-FGAIPlane::~FGAIPlane() {
-}
-
-void FGAIPlane::Update(double dt) {
- if(_pending) {
- if(tuned_station) {
- if(tuned_station->GetFreqClear()) {
- //cout << "TUNED STATION FREQ CLEAR\n";
- tuned_station->SetFreqInUse();
- _pending = false;
- _transmit = true;
- _transmitting = false;
- } else {
- if(_timeout > 0.0) { // allows count down to be avoided by initially setting it to zero
- _timeout -= dt;
- if(_timeout <= 0.0) {
- _timeout = 0.0;
- _pending = false;
- // timed out - don't render.
- if(_callback_code == 99) {
- // MEGA-HACK - 99 is the remove self callback - currently this *does* need to be run even if the transmission isn't made.
- ProcessCallback(_callback_code);
- }
- }
- }
- }
- } else {
- // Not tuned to ATC - Just go ahead and transmit
- //cout << "NOT TUNED TO ATC\n";
- _pending = false;
- _transmit = true;
- _transmitting = false;
- }
- }
-
- // This turns on rendering if on the same freq as the user
- // TODO - turn it off if user switches to another freq - keep track of where in message we are etc.
- if(_transmit) {
- //cout << "transmit\n";
- double user_freq0 = fgGetDouble("/instrumentation/comm[0]/frequencies/selected-mhz");
- double user_freq1 = fgGetDouble("/instrumentation/comm[1]/frequencies/selected-mhz");
- _counter = 0.0;
- _max_count = 5.0; // FIXME - hardwired length of message - need to calculate it!
-
- //cout << "Transmission = " << pending_transmission << '\n';
-
- // The radios dialog seems to set slightly imprecise freqs, eg 118.099998
- // The eplison stuff below is a work-around
- double eps0 = fabs(freq - user_freq0);
- double eps1 = fabs(freq - user_freq1);
- if(eps0 < 0.002 || eps1 < 0.002) {
- //cout << "Transmitting..." << endl;
- // we are on the same frequency, so check distance to the user plane
- if(1) {
- // For now assume in range !!!
- // TODO - implement range checking
- Render(plane.callsign, false);
- }
- }
- // Run the callback regardless of whether on same freq as user or not.
- if(_callback_code) {
- ProcessCallback(_callback_code);
- }
- _transmit = false;
- _transmitting = true;
- } else if(_transmitting) {
- if(_counter >= _max_count) {
- NoRender(plane.callsign);
- _transmitting = false;
- // For now we'll let ATC decide whether to respond
- //if(tuned_station) tuned_station->SetResponseReqd(plane.callsign);
- //if(tuned_station->get_ident() == "KRHV") cout << "Notifying transmission finished" << endl;
- if(tuned_station) tuned_station->NotifyTransmissionFinished(plane.callsign);
- }
- _counter += dt;
- }
-
- // Fly the plane if necessary
- if(_trackSet) {
- while((_tgtTrack - track) > 180.0) track += 360.0;
- while((track - _tgtTrack) > 180.0) track -= 360.0;
- double turn_time = 60.0;
- track += (360.0 / turn_time) * dt * (_tgtTrack > track ? 1.0 : -1.0);
- // TODO - bank a bit less for small turns.
- Bank(25.0 * (_tgtTrack > track ? 1.0 : -1.0));
- if(fabs(track - _tgtTrack) < 2.0) { // TODO - might need to optimise the delta there - it's on the large (safe) side atm.
- track = _tgtTrack;
- LevelWings();
- }
- }
-
- if(!_rollSuspended) {
- if(fabs(_roll - _tgtRoll) > 0.6) {
- // This *should* bank us smoothly to any angle
- _roll -= ((_roll - _tgtRoll)/fabs(_roll - _tgtRoll));
- } else {
- _roll = _tgtRoll;
- }
- }
-}
-
-void FGAIPlane::Transmit(int callback_code) {
- SG_LOG(SG_ATC, SG_INFO, "Transmit called for plane " << plane.callsign << ", msg = " << pending_transmission);
- _pending = true;
- _callback_code = callback_code;
- _timeout = 0.0;
-}
-
-void FGAIPlane::ConditionalTransmit(double timeout, int callback_code) {
- SG_LOG(SG_ATC, SG_INFO, "Timed transmit called for plane " << plane.callsign << ", msg = " << pending_transmission);
- _pending = true;
- _callback_code = callback_code;
- _timeout = timeout;
-}
-
-void FGAIPlane::ImmediateTransmit(int callback_code) {
- Render(plane.callsign, false);
- if(callback_code) {
- ProcessCallback(callback_code);
- }
-}
-
-// Derived classes should override this.
-void FGAIPlane::ProcessCallback(int code) {
-}
-
-// Render a transmission
-// Outputs the transmission either on screen or as audio depending on user preference
-// The refname is a string to identify this sample to the sound manager
-// The repeating flag indicates whether the message should be repeated continuously or played once.
-void FGAIPlane::Render(const string& refname, bool repeating) {
- fgSetString("/sim/messages/ai-plane", pending_transmission.c_str());
-#ifdef ENABLE_AUDIO_SUPPORT
- voice = (voiceOK && fgGetBool("/sim/sound/voice"));
- if(voice) {
- int len;
- unsigned char* buf = vPtr->WriteMessage((char*)pending_transmission.c_str(), len, voice);
- if(voice) {
- SGSoundSample* simple = new SGSoundSample(buf, len, 8000);
- // TODO - at the moment the volume is always set off comm1
- // and can't be changed after the transmission has started.
- simple->set_volume(5.0 * fgGetDouble("/instrumentation/comm[0]/volume"));
- globals->get_soundmgr()->add(simple, refname);
- if(repeating) {
- globals->get_soundmgr()->play_looped(refname);
- } else {
- globals->get_soundmgr()->play_once(refname);
- }
- }
- delete[] buf;
- }
-#endif // ENABLE_AUDIO_SUPPORT
- if(!voice) {
- // first rip the underscores and the pause hints out of the string - these are for the convienience of the voice parser
- for(unsigned int i = 0; i < pending_transmission.length(); ++i) {
- if((pending_transmission.substr(i,1) == "_") || (pending_transmission.substr(i,1) == "/")) {
- pending_transmission[i] = ' ';
- }
- }
- }
- playing = true;
-}
-
-
-// Cease rendering a transmission.
-void FGAIPlane::NoRender(const string& refname) {
- if(playing) {
- if(voice) {
-#ifdef ENABLE_AUDIO_SUPPORT
- globals->get_soundmgr()->stop(refname);
- globals->get_soundmgr()->remove(refname);
-#endif
- }
- playing = false;
- }
-}
-
-/*
-
-*/
-
-void FGAIPlane::RegisterTransmission(int code) {
-}
-
-
-// Return what type of landing we're doing on this circuit
-LandingType FGAIPlane::GetLandingOption() {
- return(FULL_STOP);
-}
-
-
-ostream& operator << (ostream& os, PatternLeg pl) {
- switch(pl) {
- case(TAKEOFF_ROLL): return(os << "TAKEOFF ROLL");
- case(CLIMBOUT): return(os << "CLIMBOUT");
- case(TURN1): return(os << "TURN1");
- case(CROSSWIND): return(os << "CROSSWIND");
- case(TURN2): return(os << "TURN2");
- case(DOWNWIND): return(os << "DOWNWIND");
- case(TURN3): return(os << "TURN3");
- case(BASE): return(os << "BASE");
- case(TURN4): return(os << "TURN4");
- case(FINAL): return(os << "FINAL");
- case(LANDING_ROLL): return(os << "LANDING ROLL");
- case(LEG_UNKNOWN): return(os << "UNKNOWN");
- }
- return(os << "ERROR - Unknown switch in PatternLeg operator << ");
-}
-
-
-ostream& operator << (ostream& os, LandingType lt) {
- switch(lt) {
- case(FULL_STOP): return(os << "FULL STOP");
- case(STOP_AND_GO): return(os << "STOP AND GO");
- case(TOUCH_AND_GO): return(os << "TOUCH AND GO");
- case(AIP_LT_UNKNOWN): return(os << "UNKNOWN");
- }
- return(os << "ERROR - Unknown switch in LandingType operator << ");
-}
-
+++ /dev/null
-// FGAIPlane - abstract base class for an AI plane
-//
-// Written by David Luff, started 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.
-
-#ifndef _FG_AI_PLANE_HXX
-#define _FG_AI_PLANE_HXX
-
-#include <simgear/math/point3d.hxx>
-
-#include "AIEntity.hxx"
-#include "ATC.hxx"
-
-enum PatternLeg {
- TAKEOFF_ROLL,
- CLIMBOUT,
- TURN1,
- CROSSWIND,
- TURN2,
- DOWNWIND,
- TURN3,
- BASE,
- TURN4,
- FINAL,
- LANDING_ROLL,
- LEG_UNKNOWN
-};
-
-ostream& operator << (ostream& os, PatternLeg pl);
-
-enum LandingType {
- FULL_STOP,
- STOP_AND_GO,
- TOUCH_AND_GO,
- AIP_LT_UNKNOWN
-};
-
-ostream& operator << (ostream& os, LandingType lt);
-
-/*****************************************************************
-*
-* FGAIPlane - this class is derived from FGAIEntity and adds the
-* practical requirement for an AI plane - the ability to send radio
-* communication, and simple performance details for the actual AI
-* implementation to use. The AI implementation is expected to be
-* in derived classes - this class does nothing useful on its own.
-*
-******************************************************************/
-class FGAIPlane : public FGAIEntity {
-
-public:
-
- FGAIPlane();
- virtual ~FGAIPlane();
-
- // Run the internal calculations
- void Update(double dt);
-
- // Send a transmission *TO* the AIPlane.
- // FIXME int code is a hack - eventually this will receive Alexander's coded messages.
- virtual void RegisterTransmission(int code);
-
- // Return the current pattern leg the plane is flying.
- inline PatternLeg GetLeg() {return leg;}
-
- // Return what type of landing we're doing on this circuit
- virtual LandingType GetLandingOption();
-
- // Return the callsign
- inline const string& GetCallsign() {return plane.callsign;}
-
-protected:
- PlaneRec plane;
-
- double mag_hdg; // degrees - the heading that the physical aircraft is *pointing*
- double track; // track that the physical aircraft is *following* - degrees relative to *true* north
- double crab; // Difference between heading and track due to wind.
- double mag_var; // degrees
- double IAS; // Indicated airspeed in knots
- double vel; // velocity along track in knots
- double vel_si; // velocity along track in m/s
- double slope; // Actual slope that the plane is flying (degrees) - +ve is uphill
- double AoA; // degrees - difference between slope and pitch
- // We'll assume that the plane doesn't yaw or slip - the track/heading difference is to allow for wind
-
- double freq; // The comm frequency that we're operating on
-
- // We need some way for this class to display its radio transmissions if on the
- // same frequency and in the vicinity of the user's aircraft
- // This may need to be done independently of ATC eg CTAF
- // Make radio transmission - this simply sends the transmission for physical rendering if the users
- // aircraft is on the same frequency and in range. It is up to the derived classes to let ATC know
- // what is going on.
- string pending_transmission; // derived classes set this string before calling Transmit(...)
- FGATC* tuned_station; // and this if they are tuned to ATC
-
- // Transmit a message when channel becomes free of other dialog
- void Transmit(int callback_code = 0);
-
- // Transmit a message if channel becomes free within timeout (seconds). timeout of zero implies no limit
- void ConditionalTransmit(double timeout, int callback_code = 0);
-
- // Transmit regardless of other dialog on the channel eg emergency
- void ImmediateTransmit(int callback_code = 0);
-
- inline void SetTrack(double t) { _tgtTrack = t; _trackSet = true; }
- inline void ClearTrack() { _trackSet = false; }
-
- inline void Bank(double r) { _tgtRoll = r; }
- inline void LevelWings(void) { _tgtRoll = 0.0; }
-
- virtual void ProcessCallback(int code);
-
- PatternLeg leg;
-
-private:
- bool _pending;
- double _timeout;
- int _callback_code; // A callback code to be notified and processed by the derived classes
- // A value of zero indicates no callback required
- bool _transmit; // we are to transmit
- bool _transmitting; // we are transmitting
- double _counter;
- double _max_count;
-
- // Render a transmission (in string pending_transmission)
- // Outputs the transmission either on screen or as audio depending on user preference
- // The refname is a string to identify this sample to the sound manager
- // The repeating flag indicates whether the message should be repeated continuously or played once.
- void Render(const string& refname, bool repeating);
-
- // Cease rendering a transmission.
- // Requires the sound manager refname if audio, else "".
- void NoRender(const string& refname);
-
- // Rendering related stuff
- bool voice; // Flag - true if we are using voice
- bool playing; // Indicates a message in progress
- bool voiceOK; // Flag - true if at least one voice has loaded OK
- FGATCVoice* vPtr;
-
- // Navigation
- double _tgtTrack; // Track to be following if _trackSet is true
- bool _trackSet; // Set true if tgtTrack is to be followed
- double _tgtRoll;
- bool _rollSuspended; // Set true when a derived class has suspended AIPlane's roll control
-};
-
-#endif // _FG_AI_PLANE_HXX
-
+++ /dev/null
-// Implementation of FGATC - ATC subsystem base class.
-//
-// Written by David Luff, started February 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 <simgear/sound/soundmgr_openal.hxx>
-#include <simgear/structure/exception.hxx>
-
-#include <Main/globals.hxx>
-#include <Main/fg_props.hxx>
-
-#include "ATC.hxx"
-
-FGATC::FGATC() {
- freqClear = true;
- receiving = false;
- respond = false;
- runResponseCounter = false;
- _runReleaseCounter = false;
- responseID = "";
- responseReqd = false;
- _type = INVALID;
- _display = false;
- _displaying = false;
-
- // Transmission timing stuff
- pending_transmission = "";
- _timeout = 0;
- _pending = false;
- _callback_code = 0;
- _transmit = false;
- _transmitting = false;
- _counter = 0.0;
- _max_count = 5.0;
-
- _voiceOK = false;
-}
-
-FGATC::~FGATC() {
-}
-
-// Derived classes wishing to use the response counter should call this from their own Update(...).
-void FGATC::Update(double dt) {
- if(runResponseCounter) {
- //cout << responseCounter << '\t' << responseTime << '\n';
- if(responseCounter >= responseTime) {
- runResponseCounter = false;
- respond = true;
- //cout << "RESPOND\n";
- } else {
- responseCounter += dt;
- }
- }
-
- if(_runReleaseCounter) {
- if(_releaseCounter >= _releaseTime) {
- freqClear = true;
- _runReleaseCounter = false;
- } else {
- _releaseCounter += dt;
- }
- }
-
- // Transmission stuff cribbed from AIPlane.cxx
- if(_pending) {
- if(GetFreqClear()) {
- //cout << "TUNED STATION FREQ CLEAR\n";
- SetFreqInUse();
- _pending = false;
- _transmit = true;
- _transmitting = false;
- } else {
- if(_timeout > 0.0) { // allows count down to be avoided by initially setting it to zero
- _timeout -= dt;
- if(_timeout <= 0.0) {
- _timeout = 0.0;
- _pending = false;
- // timed out - don't render.
- }
- }
- }
- }
-
- if(_transmit) {
- _counter = 0.0;
- _max_count = 5.0; // FIXME - hardwired length of message - need to calculate it!
-
- //cout << "Transmission = " << pending_transmission << '\n';
- if(_display) {
- //Render(pending_transmission, ident, false);
- Render(pending_transmission);
- }
- // Run the callback regardless of whether on same freq as user or not.
- //cout << "_callback_code = " << _callback_code << '\n';
- if(_callback_code) {
- ProcessCallback(_callback_code);
- }
- _transmit = false;
- _transmitting = true;
- } else if(_transmitting) {
- if(_counter >= _max_count) {
- //NoRender(plane.callsign); commented out since at the moment NoRender is designed just to stop repeating messages,
- // and this will be primarily used on single messages.
- _transmitting = false;
- //if(tuned_station) tuned_station->NotifyTransmissionFinished(plane.callsign);
- // TODO - need to let the plane the transmission is aimed at that it's finished.
- // However, for now we'll just release the frequency since if we don't it all goes pear-shaped
- _releaseCounter = 0.0;
- _releaseTime = 0.9;
- _runReleaseCounter = true;
- }
- _counter += dt;
- }
-}
-
-void FGATC::ReceiveUserCallback(int code) {
- SG_LOG(SG_ATC, SG_WARN, "WARNING - whichever ATC class was intended to receive callback code " << code << " didn't get it!!!");
-}
-
-void FGATC::SetResponseReqd(const string& rid) {
- receiving = false;
- responseReqd = true;
- respond = false; // TODO - this ignores the fact that more than one plane could call this before response
- // Shouldn't happen with AI only, but user could confuse things??
- responseID = rid;
- runResponseCounter = true;
- responseCounter = 0.0;
- responseTime = 1.8; // TODO - randomize this slightly.
-}
-
-void FGATC::NotifyTransmissionFinished(const string& rid) {
- //cout << "Transmission finished, callsign = " << rid << '\n';
- receiving = false;
- responseID = rid;
- if(responseReqd) {
- runResponseCounter = true;
- responseCounter = 0.0;
- responseTime = 1.2; // TODO - randomize this slightly, and allow it to be dependent on the transmission and how busy the ATC is.
- respond = false; // TODO - this ignores the fact that more than one plane could call this before response
- // Shouldn't happen with AI only, but user could confuse things??
- } else {
- freqClear = true;
- }
-}
-
-void FGATC::Transmit(int callback_code) {
- SG_LOG(SG_ATC, SG_INFO, "Transmit called by " << ident << " " << _type << ", msg = " << pending_transmission);
- _pending = true;
- _callback_code = callback_code;
- _timeout = 0.0;
-}
-
-void FGATC::ConditionalTransmit(double timeout, int callback_code) {
- SG_LOG(SG_ATC, SG_INFO, "Timed transmit called by " << ident << " " << _type << ", msg = " << pending_transmission);
- _pending = true;
- _callback_code = callback_code;
- _timeout = timeout;
-}
-
-void FGATC::ImmediateTransmit(int callback_code) {
- SG_LOG(SG_ATC, SG_INFO, "Immediate transmit called by " << ident << " " << _type << ", msg = " << pending_transmission);
- if(_display) {
- //Render(pending_transmission, ident, false);
- Render(pending_transmission);
- // At the moment Render doesn't work except for ATIS
- }
- if(callback_code) {
- ProcessCallback(callback_code);
- }
-}
-
-// Derived classes should override this.
-void FGATC::ProcessCallback(int code) {
-}
-
-void FGATC::AddPlane(const string& pid) {
-}
-
-int FGATC::RemovePlane() {
- return 0;
-}
-
-void FGATC::SetData(ATCData* d) {
- lon = d->lon;
- lat = d->lat;
- elev = d->elev;
- x = d->x;
- y = d->y;
- z = d->z;
- range = d->range;
- ident = d->ident;
- name = d->name;
- freq = d->freq;
-}
-
-// Render a transmission
-// Outputs the transmission either on screen or as audio depending on user preference
-// The refname is a string to identify this sample to the sound manager
-// The repeating flag indicates whether the message should be repeated continuously or played once.
-void FGATC::Render(string& msg, const string& refname, bool repeating) {
- if (repeating)
- fgSetString("/sim/messages/atis", msg.c_str());
- else
- fgSetString("/sim/messages/atc", msg.c_str());
-
- #ifdef ENABLE_AUDIO_SUPPORT
- _voice = (_voiceOK && fgGetBool("/sim/sound/voice"));
- if(_voice) {
- int len;
- unsigned char* buf = _vPtr->WriteMessage((char*)msg.c_str(), len, _voice);
- if(_voice) {
- try {
- SGSoundSample *simple
- = new SGSoundSample(buf, len, 8000);
- // TODO - at the moment the volume is always set off comm1
- // and can't be changed after the transmission has started.
- simple->set_volume(5.0 * fgGetDouble("/instrumentation/comm[0]/volume"));
- globals->get_soundmgr()->add(simple, refname);
- if(repeating) {
- globals->get_soundmgr()->play_looped(refname);
- } else {
- globals->get_soundmgr()->play_once(refname);
- }
- } catch ( sg_io_exception &e ) {
- SG_LOG(SG_GENERAL, SG_ALERT, e.getFormattedMessage());
- }
- }
- delete[] buf;
- }
- #endif // ENABLE_AUDIO_SUPPORT
- if(!_voice) {
- // first rip the underscores and the pause hints out of the string - these are for the convienience of the voice parser
- for(unsigned int i = 0; i < msg.length(); ++i) {
- if((msg.substr(i,1) == "_") || (msg.substr(i,1) == "/")) {
- msg[i] = ' ';
- }
- }
- }
- _playing = true;
-}
-
-
-// Cease rendering a transmission.
-void FGATC::NoRender(const string& refname) {
- if(_playing) {
- if(_voice) {
-#ifdef ENABLE_AUDIO_SUPPORT
- globals->get_soundmgr()->stop(refname);
- globals->get_soundmgr()->remove(refname);
-#endif
- }
- _playing = false;
- }
-}
-
-// Generate the text of a message from its parameters and the current context.
-string FGATC::GenText(const string& m, int c) {
- return("");
-}
-
-ostream& operator << (ostream& os, atc_type atc) {
- switch(atc) {
- case(INVALID): return(os << "INVALID");
- case(ATIS): return(os << "ATIS");
- case(GROUND): return(os << "GROUND");
- case(TOWER): return(os << "TOWER");
- case(APPROACH): return(os << "APPROACH");
- case(DEPARTURE): return(os << "DEPARTURE");
- case(ENROUTE): return(os << "ENROUTE");
- }
- return(os << "ERROR - Unknown switch in atc_type operator << ");
-}
+++ /dev/null
-// FGATC - abstract base class for the various actual atc classes
-// such as FGATIS, FGTower etc.
-//
-// Written by David Luff, started Feburary 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.
-
-#ifndef _FG_ATC_HXX
-#define _FG_ATC_HXX
-
-#include <simgear/constants.h>
-#include <simgear/compiler.h>
-#include <simgear/misc/sgstream.hxx>
-#include <simgear/math/sg_geodesy.hxx>
-#include <simgear/debug/logstream.hxx>
-
-#include STL_IOSTREAM
-#include STL_STRING
-
-#include "ATCVoice.hxx"
-
-SG_USING_STD(ostream);
-SG_USING_STD(string);
-SG_USING_STD(ios);
-
-enum plane_type {
- UNKNOWN,
- GA_SINGLE,
- GA_HP_SINGLE,
- GA_TWIN,
- GA_JET,
- MEDIUM,
- HEAVY,
- MIL_JET
-};
-
-// PlaneRec - a structure holding ATC-centric details of planes under control
-// This might move or change eventually
-struct PlaneRec {
- plane_type type;
- string callsign;
- int squawkcode;
-};
-
-// Possible types of ATC type that the radios may be tuned to.
-// INVALID implies not tuned in to anything.
-enum atc_type {
- INVALID,
- ATIS,
- GROUND,
- TOWER,
- APPROACH,
- DEPARTURE,
- ENROUTE
-};
-
-const int ATC_NUM_TYPES = 7;
-
-// DCL - new experimental ATC data store
-struct ATCData {
- atc_type type;
- // I've deliberately used float instead of double here to keep the size down - we'll be storing thousands of these in memory.
- // In fact, we could probably ditch x, y and z and generate on the fly as needed.
- // On the other hand, we'll probably end up reading this data directly from the DAFIF eventually anyway!!
- float lon, lat, elev;
- float x, y, z;
- //int freq;
- unsigned short int freq;
- //int range;
- unsigned short int range;
- string ident;
- string name;
-};
-
-// perhaps we could use an FGRunway instead of this.
-// That wouldn't cache the orthopos though.
-struct RunwayDetails {
- Point3D threshold_pos;
- Point3D end1ortho; // ortho projection end1 (the threshold ATM)
- Point3D end2ortho; // ortho projection end2 (the take off end in the current hardwired scheme)
- double hdg; // true runway heading
- double length; // In *METERS*
- double width; // ditto
- string rwyID;
- int patternDirection; // -1 for left, 1 for right
-};
-
-ostream& operator << (ostream& os, atc_type atc);
-
-class FGATC {
-
-public:
-
- FGATC();
- virtual ~FGATC();
-
- // Run the internal calculations
- // Derived classes should call this method from their own Update methods if they
- // wish to use the response timer functionality.
- virtual void Update(double dt);
-
- // Recieve a coded callback from the ATC menu system based on the user's selection
- virtual void ReceiveUserCallback(int code);
-
- // Add plane to a stack
- virtual void AddPlane(const string& pid);
-
- // Remove plane from stack
- virtual int RemovePlane();
-
- // Indicate that this instance should output to the display if appropriate
- inline void SetDisplay() { _display = true; }
-
- // Indicate that this instance should not output to the display
- inline void SetNoDisplay() { _display = false; }
-
- // Generate the text of a message from its parameters and the current context.
- virtual string GenText(const string& m, int c);
-
- // Returns true if OK to transmit on this frequency
- inline bool GetFreqClear() { return freqClear; }
- // Indicate that the frequency is in use
- inline void SetFreqInUse() { freqClear = false; receiving = true; }
- // Transmission to the ATC is finished and a response is required
- void SetResponseReqd(const string& rid);
- // Transmission finished - let ATC decide if a response is reqd and clear freq if necessary
- void NotifyTransmissionFinished(const string& rid);
- // Transmission finished and no response required
- inline void ReleaseFreq() { freqClear = true; receiving = false; } // TODO - check that the plane releasing the freq is the right one etc.
- // The above 3 funcs under development!!
- // The idea is that AI traffic or the user ATC dialog box calls FreqInUse() when they begin transmitting,
- // and that the tower control sets freqClear back to true following a reply.
- // AI traffic should check FreqClear() is true prior to transmitting.
- // The user will just have to wait for a gap in dialog as in real life.
-
- // Return the type of ATC station that the class represents
- inline atc_type GetType() { return _type; }
-
- // Set the core ATC data
- void SetData(ATCData* d);
-
- inline double get_lon() const { return lon; }
- inline void set_lon(const double ln) {lon = ln;}
- inline double get_lat() const { return lat; }
- inline void set_lat(const double lt) {lat = lt;}
- inline double get_elev() const { return elev; }
- inline void set_elev(const double ev) {elev = ev;}
- inline double get_x() const { return x; }
- inline void set_x(const double ecs) {x = ecs;}
- inline double get_y() const { return y; }
- inline void set_y(const double why) {y = why;}
- inline double get_z() const { return z; }
- inline void set_z(const double zed) {z = zed;}
- inline int get_freq() const { return freq; }
- inline void set_freq(const int fq) {freq = fq;}
- inline int get_range() const { return range; }
- inline void set_range(const int rg) {range = rg;}
- inline const string& get_ident() { return ident; }
- inline void set_ident(const string& id) { ident = id; }
- inline const string& get_name() { return name; }
- inline void set_name(const string& nm) { name = nm; }
-
-protected:
-
- // Render a transmission
- // Outputs the transmission either on screen or as audio depending on user preference
- // The refname is a string to identify this sample to the sound manager
- // The repeating flag indicates whether the message should be repeated continuously or played once.
- void Render(string& msg, const string& refname = "", bool repeating = false);
-
- // Cease rendering all transmission from this station.
- // Requires the sound manager refname if audio, else "".
- void NoRender(const string& refname);
-
- // Transmit a message when channel becomes free of other dialog
- void Transmit(int callback_code = 0);
-
- // Transmit a message if channel becomes free within timeout (seconds). timeout of zero implies no limit
- void ConditionalTransmit(double timeout, int callback_code = 0);
-
- // Transmit regardless of other dialog on the channel eg emergency
- void ImmediateTransmit(int callback_code = 0);
-
- virtual void ProcessCallback(int code);
-
- double lon, lat, elev;
- double x, y, z;
- int freq;
- int range;
- string ident; // Code of the airport its at.
- string name; // Name transmitted in the broadcast.
- atc_type _type;
-
- // Rendering related stuff
- bool _voice; // Flag - true if we are using voice
- bool _playing; // Indicates a message in progress
- bool _voiceOK; // Flag - true if at least one voice has loaded OK
- FGATCVoice* _vPtr;
-
- string pending_transmission; // derived classes set this string before calling Transmit(...)
- bool freqClear; // Flag to indicate if the frequency is clear of ongoing dialog
- bool receiving; // Flag to indicate we are receiving a transmission
- bool responseReqd; // Flag to indicate we should be responding to a request/report
- bool runResponseCounter; // Flag to indicate the response counter should be run
- double responseTime; // Time to take from end of request transmission to beginning of response
- // The idea is that this will be slightly random.
- double responseCounter; // counter to implement the above
- string responseID; // ID of the plane to respond to
- bool respond; // Flag to indicate now is the time to respond - ie set following the count down of the response timer.
- // Derived classes only need monitor this flag, and use the response ID, as long as they call FGATC::Update(...)
- bool _runReleaseCounter; // A timer for releasing the frequency after giving the message enough time to display
- double _releaseTime;
- double _releaseCounter;
-
- bool _display; // Flag to indicate whether we should be outputting to the ATC display.
- bool _displaying; // Flag to indicate whether we are outputting to the ATC display.
-
-private:
- // Transmission timing stuff.
- bool _pending;
- double _timeout;
- int _callback_code; // A callback code to be notified and processed by the derived classes
- // A value of zero indicates no callback required
- bool _transmit; // we are to transmit
- bool _transmitting; // we are transmitting
- double _counter;
- double _max_count;
-};
-
-inline istream&
-operator >> ( istream& fin, ATCData& a )
-{
- double f;
- char ch;
- char tp;
-
- fin >> tp;
-
- switch(tp) {
- case 'I':
- a.type = ATIS;
- break;
- case 'T':
- a.type = TOWER;
- break;
- case 'G':
- a.type = GROUND;
- break;
- case 'A':
- a.type = APPROACH;
- break;
- case '[':
- a.type = INVALID;
- return fin >> skipeol;
- default:
- SG_LOG(SG_GENERAL, SG_ALERT, "Warning - unknown type \'" << tp << "\' found whilst reading ATC frequency data!\n");
- a.type = INVALID;
- return fin >> skipeol;
- }
-
- fin >> a.lat >> a.lon >> a.elev >> f >> a.range
- >> a.ident;
-
- a.name = "";
- fin >> ch;
- if(ch != '"') a.name += ch;
- while(1) {
- //in >> noskipws
- fin.unsetf(ios::skipws);
- fin >> ch;
- if((ch == '"') || (ch == 0x0A)) {
- break;
- } // we shouldn't need the 0x0A but it makes a nice safely in case someone leaves off the "
- a.name += ch;
- }
- fin.setf(ios::skipws);
- //cout << "Comm name = " << a.name << '\n';
-
- a.freq = (int)(f*100.0 + 0.5);
-
- // cout << a.ident << endl;
-
- // generate cartesian coordinates
- Point3D geod( a.lon * SGD_DEGREES_TO_RADIANS, a.lat * SGD_DEGREES_TO_RADIANS, a.elev );
- Point3D cart = sgGeodToCart( geod );
- a.x = cart.x();
- a.y = cart.y();
- a.z = cart.z();
-
- return fin >> skipeol;
-}
-
-
-#endif // _FG_ATC_HXX
+++ /dev/null
-// ATCDialog.cxx - Functions and classes to handle the pop-up ATC dialog
-//
-// Written by Alexander Kappes and David Luff, started February 2003.
-//
-// Copyright (C) 2003 Alexander Kappes and David Luff
-//
-// 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 <simgear/compiler.h>
-
-#include <simgear/structure/commands.hxx>
-
-#include <Main/globals.hxx>
-#include <GUI/gui.h> // mkDialog
-#include <GUI/new_gui.hxx>
-
-#include "ATCDialog.hxx"
-#include "ATC.hxx"
-#include "ATCmgr.hxx"
-#include "commlist.hxx"
-#include "ATCutils.hxx"
-#include <Airports/simple.hxx>
-
-#include <sstream>
-
-SG_USING_STD(ostringstream);
-
-FGATCDialog *current_atcdialog;
-
-// For the command manager - maybe eventually this should go in the built in command list
-static bool do_ATC_dialog(const SGPropertyNode* arg) {
- current_atcdialog->PopupDialog();
- return(true);
-}
-
-static bool do_ATC_freq_search(const SGPropertyNode* arg) {
- current_atcdialog->FreqDialog();
- return(true);
-}
-
-ATCMenuEntry::ATCMenuEntry() {
- stationid = "";
- //stationfr = 0;
- transmission = "";
- menuentry = "";
- callback_code = 0;
-}
-
-ATCMenuEntry::~ATCMenuEntry() {
-}
-
-static void atcUppercase(string &s) {
- for(unsigned int i=0; i<s.size(); ++i) {
- s[i] = toupper(s[i]);
- }
-}
-
-// find child whose <name>...</name> entry matches 'name'
-static SGPropertyNode *getNamedNode(SGPropertyNode *prop, const char *name) {
- SGPropertyNode* p;
-
- for (int i = 0; i < prop->nChildren(); i++)
- if ((p = getNamedNode(prop->getChild(i), name)))
- return p;
-
- if (!strcmp(prop->getStringValue("name"), name))
- return prop;
-
- return 0;
-}
-
-
-FGATCDialog::FGATCDialog() {
- _callbackPending = false;
- _callbackTimer = 0.0;
- _callbackWait = 0.0;
- _callbackPtr = NULL;
- _callbackCode = 0;
- _gui = (NewGUI *)globals->get_subsystem("gui");
-}
-
-FGATCDialog::~FGATCDialog() {
-}
-
-void FGATCDialog::Init() {
- // Add ATC-dialog to the command list
- globals->get_commands()->addCommand("ATC-dialog", do_ATC_dialog);
- // Add ATC-freq-search to the command list
- globals->get_commands()->addCommand("ATC-freq-search", do_ATC_freq_search);
-
- // initialize properties polled in Update()
- globals->get_props()->setStringValue("/sim/atc/freq-airport", "");
- globals->get_props()->setIntValue("/sim/atc/transmission-num", -1);
-}
-
-void FGATCDialog::Update(double dt) {
- static SGPropertyNode_ptr airport = globals->get_props()->getNode("/sim/atc/freq-airport", true);
- string s = airport->getStringValue();
- if (!s.empty()) {
- airport->setStringValue("");
- FreqDisplay(s);
- }
-
- static SGPropertyNode_ptr trans_num = globals->get_props()->getNode("/sim/atc/transmission-num", true);
- int n = trans_num->getIntValue();
- if (n >= 0) {
- trans_num->setIntValue(-1);
- PopupCallback(n);
- }
-
- if(_callbackPending) {
- if(_callbackTimer > _callbackWait) {
- _callbackPtr->ReceiveUserCallback(_callbackCode);
- _callbackPtr->NotifyTransmissionFinished(fgGetString("/sim/user/callsign"));
- _callbackPending = false;
- } else {
- _callbackTimer += dt;
- }
- }
-}
-
-// Add an entry
-void FGATCDialog::add_entry(const string& station, const string& transmission, const string& menutext, atc_type type, int code) {
-
- ATCMenuEntry a;
-
- a.stationid = station;
- a.transmission = transmission;
- a.menuentry = menutext;
- a.callback_code = code;
-
- (available_dialog[type])[station.c_str()].push_back(a);
-
-}
-
-void FGATCDialog::remove_entry( const string &station, const string &trans, atc_type type ) {
- atcmentry_vec_type* p = &((available_dialog[type])[station]);
- atcmentry_vec_iterator current = p->begin();
- while(current != p->end()) {
- if(current->transmission == trans) current = p->erase(current);
- else ++current;
- }
-}
-
-void FGATCDialog::remove_entry( const string &station, int code, atc_type type ) {
- atcmentry_vec_type* p = &((available_dialog[type])[station]);
- atcmentry_vec_iterator current = p->begin();
- while(current != p->end()) {
- if(current->callback_code == code) current = p->erase(current);
- else ++current;
- }
-}
-
-// query the database whether the transmission is already registered;
-bool FGATCDialog::trans_reg( const string &station, const string &trans, atc_type type ) {
- atcmentry_vec_type* p = &((available_dialog[type])[station]);
- atcmentry_vec_iterator current = p->begin();
- for ( ; current != p->end() ; ++current ) {
- if ( current->transmission == trans ) return true;
- }
- return false;
-}
-
-// query the database whether the transmission is already registered;
-bool FGATCDialog::trans_reg( const string &station, int code, atc_type type ) {
- atcmentry_vec_type* p = &((available_dialog[type])[station]);
- atcmentry_vec_iterator current = p->begin();
- for ( ; current != p->end() ; ++current ) {
- if ( current->callback_code == code ) return true;
- }
- return false;
-}
-
-// Display the ATC popup dialog box with options relevant to the users current situation.
-void FGATCDialog::PopupDialog() {
- const char *dialog_name = "atc-dialog";
- SGPropertyNode_ptr dlg = _gui->getDialogProperties(dialog_name);
- if (!dlg)
- return;
-
- _gui->closeDialog(dialog_name);
-
- SGPropertyNode_ptr button_group = getNamedNode(dlg, "transmission-choice");
- // remove all transmission buttons
- button_group->removeChildren("button", false);
-
- string label;
- FGATC* atcptr = globals->get_ATC_mgr()->GetComm1ATCPointer(); // Hardwired to comm1 at the moment
-
- if (!atcptr) {
- label = "Not currently tuned to any ATC service";
- mkDialog(label.c_str());
- return;
- }
-
- if(atcptr->GetType() == ATIS) {
- label = "Tuned to ATIS - no communication possible";
- mkDialog(label.c_str());
- return;
- }
-
- atcmentry_vec_type atcmlist = (available_dialog[atcptr->GetType()])[atcptr->get_ident()];
- atcmentry_vec_iterator current = atcmlist.begin();
- atcmentry_vec_iterator last = atcmlist.end();
-
- if(!atcmlist.size()) {
- label = "No transmission available";
- mkDialog(label.c_str());
- return;
- }
-
- const int bufsize = 32;
- char buf[bufsize];
- // loop over all entries in atcmentrylist
- for (int n = 0; n < 10; ++n) {
- snprintf(buf, bufsize, "/sim/atc/opt[%d]", n);
- fgSetBool(buf, false);
-
- if (current == last)
- continue;
-
- // add transmission button (modified copy of <button-template>)
- SGPropertyNode *entry = button_group->getNode("button", n, true);
- copyProperties(button_group->getNode("button-template", true), entry);
- entry->removeChildren("hide", false);
- entry->setStringValue("property", buf);
- entry->setIntValue("keynum", '1' + n);
- if (n == 0)
- entry->setBoolValue("default", true);
-
- snprintf(buf, bufsize, "%d", n + 1);
- string legend = string(buf) + ". " + current->menuentry;
- entry->setStringValue("legend", legend.c_str());
- entry->setIntValue("binding/value", n);
- current++;
- }
-
- _gui->showDialog(dialog_name);
- return;
-}
-
-void FGATCDialog::PopupCallback(int num) {
- FGATC* atcptr = globals->get_ATC_mgr()->GetComm1ATCPointer(); // FIXME - Hardwired to comm1 at the moment
-
- if (!atcptr)
- return;
-
- if (atcptr->GetType() == TOWER) {
- //cout << "TOWER " << endl;
- //cout << "ident is " << atcptr->get_ident() << endl;
- atcmentry_vec_type atcmlist = (available_dialog[TOWER])[atcptr->get_ident()];
- unsigned int size = atcmlist.size();
- if(size && num < size) {
- //cout << "Doing callback...\n";
- ATCMenuEntry a = atcmlist[num];
- atcptr->SetFreqInUse();
- string pilot = atcptr->GenText(a.transmission, a.callback_code);
- fgSetString("/sim/messages/pilot", pilot.c_str());
- // This is the user's speech getting displayed.
- _callbackPending = true;
- _callbackTimer = 0.0;
- _callbackWait = 5.0;
- _callbackPtr = atcptr;
- _callbackCode = a.callback_code;
- } else {
- //cout << "No options available...\n";
- }
- //cout << "Donded" << endl;
- }
-}
-
-// map() key data type (removes duplicates and sorts by distance)
-struct atcdata {
- atcdata() {}
- atcdata(const string i, const string n, const double d) {
- id = i, name = n, distance = d;
- }
- bool operator<(const atcdata& a) const {
- return id != a.id && distance < a.distance;
- }
- bool operator==(const atcdata& a) const {
- return id == a.id && distance == a.distance;
- }
- string id;
- string name;
- double distance;
-};
-
-void FGATCDialog::FreqDialog() {
- const char *dialog_name = "atc-freq-search";
- SGPropertyNode_ptr dlg = _gui->getDialogProperties(dialog_name);
- if (!dlg)
- return;
-
- _gui->closeDialog(dialog_name);
-
- SGPropertyNode_ptr button_group = getNamedNode(dlg, "quick-buttons");
- // remove all dynamic airport/ATC buttons
- button_group->removeChildren("button", false);
-
- // Find the ATC stations within a reasonable range
- comm_list_type atc_stations;
- comm_list_iterator atc_stat_itr;
-
- double lon = fgGetDouble("/position/longitude-deg");
- double lat = fgGetDouble("/position/latitude-deg");
- double elev = fgGetDouble("/position/altitude-ft");
- Point3D aircraft = sgGeodToCart(Point3D(lon * SGD_DEGREES_TO_RADIANS,
- lat * SGD_DEGREES_TO_RADIANS, elev));
-
- // search stations in range
- int num_stat = current_commlist->FindByPos(lon, lat, elev, 50.0, &atc_stations);
- if (num_stat != 0) {
- map<atcdata, bool> uniq;
- // fill map (sorts by distance and removes duplicates)
- comm_list_iterator itr = atc_stations.begin();
- for (; itr != atc_stations.end(); ++itr) {
- Point3D station = Point3D(itr->x, itr->y, itr->z);
- double distance = aircraft.distance3Dsquared(station);
- uniq[atcdata(itr->ident, itr->name, distance)] = true;
- }
- // create button per map entry (modified copy of <button-template>)
- map<atcdata, bool>::iterator uit = uniq.begin();
- for (int n = 0; uit != uniq.end() && n < 6; ++uit, ++n) { // max 6 buttons
- SGPropertyNode *entry = button_group->getNode("button", n, true);
- copyProperties(button_group->getNode("button-template", true), entry);
- entry->removeChildren("hide", false);
- entry->setStringValue("legend", uit->first.id.c_str());
- entry->setStringValue("binding[0]/value", uit->first.id.c_str());
- }
- }
-
- // (un)hide message saying no things in range
- SGPropertyNode_ptr range_error = getNamedNode(dlg, "no-atc-in-range");
- range_error->setBoolValue("hide", num_stat);
-
- _gui->showDialog(dialog_name);
-}
-
-void FGATCDialog::FreqDisplay(string& ident) {
- const char *dialog_name = "atc-freq-display";
- SGPropertyNode_ptr dlg = _gui->getDialogProperties(dialog_name);
- if (!dlg)
- return;
-
- _gui->closeDialog(dialog_name);
-
- SGPropertyNode_ptr freq_group = getNamedNode(dlg, "frequency-list");
- // remove all frequency entries
- freq_group->removeChildren("group", false);
-
- atcUppercase(ident);
- string label;
-
- const FGAirport *a = fgFindAirportID(ident);
- if (!a) {
- label = "Airport " + ident + " not found in database.";
- mkDialog(label.c_str());
- return;
- }
-
- // set title
- label = ident + " Frequencies";
- dlg->setStringValue("text/label", label.c_str());
-
- int n = 0; // Number of ATC frequencies at this airport
-
- comm_list_type stations;
- int found = current_commlist->FindByPos(a->getLongitude(), a->getLatitude(), a->getElevation(), 20.0, &stations);
- if(found) {
- ostringstream ostr;
- comm_list_iterator itr = stations.begin();
- for (n = 0; itr != stations.end(); ++itr) {
- if(itr->ident != ident)
- continue;
-
- if(itr->type == INVALID)
- continue;
-
- // add frequency line (modified copy of <group-template>)
- SGPropertyNode *entry = freq_group->getNode("group", n, true);
- copyProperties(freq_group->getNode("group-template", true), entry);
- entry->removeChildren("hide", false);
-
- ostr << itr->type;
- entry->setStringValue("text[0]/label", ostr.str().c_str());
-
- char buf[8];
- snprintf(buf, 8, "%.2f", (itr->freq / 100.0)); // Convert from KHz to MHz
- if(buf[5] == '3') buf[5] = '2';
- if(buf[5] == '8') buf[5] = '7';
- buf[7] = '\0';
-
- entry->setStringValue("text[1]/label", buf);
-
- ostr.seekp(0);
- n++;
- }
- }
- if(n == 0) {
- label = "No frequencies found for airport " + ident;
- mkDialog(label.c_str());
- return;
- }
-
- _gui->showDialog(dialog_name);
-}
-
+++ /dev/null
-// ATCDialog.hxx - Functions and classes to handle the pop-up ATC dialog
-//
-// Written by Alexander Kappes and David Luff, started February 2003.
-//
-// Copyright (C) 2003 Alexander Kappes and David Luff
-//
-// 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 ATC_DIALOG_HXX
-#define ATC_DIALOG_HXX
-
-#include <simgear/compiler.h>
-
-#include <vector>
-#include <map>
-
-#include "ATC.hxx"
-
-SG_USING_STD(vector);
-SG_USING_STD(map);
-
-class NewGUI;
-
-// ATCMenuEntry - an encapsulation of an entry in the ATC dialog
-struct ATCMenuEntry {
-
- string stationid; // ID of transmitting station
- //int stationfr; // ?
- string transmission; // Actual speech of transmission
- string menuentry; // Shortened version for display in the dialog
- int callback_code; // This code is supplied by the registering station, and then
- // returned to the registering station if that option is chosen.
- // The actual value is only understood by the registering station -
- // FGATCDialog only stores it and returns it if appropriate.
-
- ATCMenuEntry();
- ~ATCMenuEntry();
-};
-
-typedef vector < ATCMenuEntry > atcmentry_vec_type;
-typedef atcmentry_vec_type::iterator atcmentry_vec_iterator;
-
-typedef map < string, atcmentry_vec_type > atcmentry_map_type;
-typedef atcmentry_map_type::iterator atcmentry_map_iterator;
-
-//void ATCDialogInit();
-
-//void ATCDoDialog(atc_type type);
-
-class FGATCDialog {
-
-public:
-
- FGATCDialog();
- ~FGATCDialog();
-
- void Init();
-
- void Update(double dt);
-
- void PopupDialog();
-
- void PopupCallback(int);
-
- void add_entry( const string& station, const string& transmission, const string& menutext, atc_type type, int code);
-
- void remove_entry( const string &station, const string &trans, atc_type type );
-
- void remove_entry( const string &station, int code, atc_type type );
-
- // query the database whether the transmission is already registered;
- bool trans_reg( const string &station, const string &trans, atc_type type );
-
- // query the database whether the transmission is already registered;
- bool trans_reg( const string &station, int code, atc_type type );
-
- // Display a frequency search dialog for nearby stations
- void FreqDialog();
-
- // Display the comm ATC frequencies for airport ident
- // where ident is a valid ICAO code.
- void FreqDisplay(string& ident);
-
-private:
-
- atcmentry_map_type available_dialog[ATC_NUM_TYPES];
-
- int freq;
- bool reset;
-
- bool _callbackPending;
- double _callbackTimer;
- double _callbackWait;
- FGATC* _callbackPtr;
- int _callbackCode;
-
- NewGUI *_gui;
-};
-
-extern FGATCDialog *current_atcdialog;
-
-#endif // ATC_DIALOG_HXX
-
+++ /dev/null
-// ATCProjection.cxx - A convienience projection class for the ATC/AI system.
-//
-// Written by David Luff, started 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 "ATCProjection.hxx"
-#include <math.h>
-#include <simgear/constants.h>
-
-FGATCProjection::FGATCProjection() {
- _origin.setlat(0.0);
- _origin.setlon(0.0);
- _origin.setelev(0.0);
- _correction_factor = cos(_origin.lat() * SG_DEGREES_TO_RADIANS);
-}
-
-FGATCProjection::FGATCProjection(const Point3D& centre) {
- _origin = centre;
- _correction_factor = cos(_origin.lat() * SG_DEGREES_TO_RADIANS);
-}
-
-FGATCProjection::~FGATCProjection() {
-}
-
-void FGATCProjection::Init(const Point3D& centre) {
- _origin = centre;
- _correction_factor = cos(_origin.lat() * SG_DEGREES_TO_RADIANS);
-}
-
-Point3D FGATCProjection::ConvertToLocal(const Point3D& pt) {
- double delta_lat = pt.lat() - _origin.lat();
- double delta_lon = pt.lon() - _origin.lon();
-
- double y = sin(delta_lat * SG_DEGREES_TO_RADIANS) * SG_EQUATORIAL_RADIUS_M;
- double x = sin(delta_lon * SG_DEGREES_TO_RADIANS) * SG_EQUATORIAL_RADIUS_M * _correction_factor;
-
- return(Point3D(x,y,0.0));
-}
-
-Point3D FGATCProjection::ConvertFromLocal(const Point3D& pt) {
- double delta_lat = asin(pt.y() / SG_EQUATORIAL_RADIUS_M) * SG_RADIANS_TO_DEGREES;
- double delta_lon = (asin(pt.x() / SG_EQUATORIAL_RADIUS_M) * SG_RADIANS_TO_DEGREES) / _correction_factor;
-
- return(Point3D(_origin.lon()+delta_lon, _origin.lat()+delta_lat, 0.0));
-}
-
-/**********************************************************************************/
-
-FGATCAlignedProjection::FGATCAlignedProjection() {
- _origin.setlat(0.0);
- _origin.setlon(0.0);
- _origin.setelev(0.0);
- _correction_factor = cos(_origin.lat() * SG_DEGREES_TO_RADIANS);
-}
-
-FGATCAlignedProjection::FGATCAlignedProjection(const Point3D& centre, double heading) {
- _origin = centre;
- _theta = heading * SG_DEGREES_TO_RADIANS;
- _correction_factor = cos(_origin.lat() * SG_DEGREES_TO_RADIANS);
-}
-
-FGATCAlignedProjection::~FGATCAlignedProjection() {
-}
-
-void FGATCAlignedProjection::Init(const Point3D& centre, double heading) {
- _origin = centre;
- _theta = heading * SG_DEGREES_TO_RADIANS;
- _correction_factor = cos(_origin.lat() * SG_DEGREES_TO_RADIANS);
-}
-
-Point3D FGATCAlignedProjection::ConvertToLocal(const Point3D& pt) {
- // convert from lat/lon to orthogonal
- double delta_lat = pt.lat() - _origin.lat();
- double delta_lon = pt.lon() - _origin.lon();
- double y = sin(delta_lat * SG_DEGREES_TO_RADIANS) * SG_EQUATORIAL_RADIUS_M;
- double x = sin(delta_lon * SG_DEGREES_TO_RADIANS) * SG_EQUATORIAL_RADIUS_M * _correction_factor;
-
- // Align
- if(_theta != 0.0) {
- double xbar = x;
- x = x*cos(_theta) - y*sin(_theta);
- y = (xbar*sin(_theta)) + (y*cos(_theta));
- }
-
- return(Point3D(x,y,pt.elev()));
-}
-
-Point3D FGATCAlignedProjection::ConvertFromLocal(const Point3D& pt) {
- // de-align
- double thi = _theta * -1.0;
- double x = pt.x()*cos(thi) - pt.y()*sin(thi);
- double y = (pt.x()*sin(thi)) + (pt.y()*cos(thi));
-
- // convert from orthogonal to lat/lon
- double delta_lat = asin(y / SG_EQUATORIAL_RADIUS_M) * SG_RADIANS_TO_DEGREES;
- double delta_lon = (asin(x / SG_EQUATORIAL_RADIUS_M) * SG_RADIANS_TO_DEGREES) / _correction_factor;
-
- return(Point3D(_origin.lon()+delta_lon, _origin.lat()+delta_lat, pt.elev()));
-}
+++ /dev/null
-// ATCProjection.hxx - A convienience projection class for the ATC/AI system.
-//
-// Written by David Luff, started 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.
-
-#ifndef _FG_ATC_PROJECTION_HXX
-#define _FG_ATC_PROJECTION_HXX
-
-#include <simgear/math/point3d.hxx>
-
-// FGATCProjection - a class to project an area local to an airport onto an orthogonal co-ordinate system
-class FGATCProjection {
-
-public:
- FGATCProjection();
- FGATCProjection(const Point3D& centre);
- ~FGATCProjection();
-
- void Init(const Point3D& centre);
-
- // Convert a lat/lon co-ordinate (degrees) to the local projection (meters)
- Point3D ConvertToLocal(const Point3D& pt);
-
- // Convert a local projection co-ordinate (meters) to lat/lon (degrees)
- Point3D ConvertFromLocal(const Point3D& pt);
-
-private:
- Point3D _origin; // lat/lon of local area origin
- double _correction_factor; // Reduction in surface distance per degree of longitude due to latitude. Saves having to do a cos() every call.
-
-};
-
-
-// FGATCAlignedProjection - a class to project an area local to a runway onto an orthogonal co-ordinate system
-// with the origin at the threshold and the runway aligned with the y axis.
-class FGATCAlignedProjection {
-
-public:
- FGATCAlignedProjection();
- FGATCAlignedProjection(const Point3D& centre, double heading);
- ~FGATCAlignedProjection();
-
- void Init(const Point3D& centre, double heading);
-
- // Convert a lat/lon co-ordinate (degrees) to the local projection (meters)
- Point3D ConvertToLocal(const Point3D& pt);
-
- // Convert a local projection co-ordinate (meters) to lat/lon (degrees)
- Point3D ConvertFromLocal(const Point3D& pt);
-
-private:
- Point3D _origin; // lat/lon of local area origin (the threshold)
- double _theta; // the rotation angle for alignment in radians
- double _correction_factor; // Reduction in surface distance per degree of longitude due to latitude. Saves having to do a cos() every call.
-
-};
-
-#endif // _FG_ATC_PROJECTION_HXX
+++ /dev/null
-// FGATCVoice.cxx - a class to encapsulate an ATC voice
-//
-// Written by David Luff, started November 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 <simgear/misc/sg_path.hxx>
-#include <simgear/debug/logstream.hxx>
-#include <simgear/misc/sgstream.hxx>
-#include <simgear/math/sg_random.h>
-#include <Main/globals.hxx>
-
-#include "ATCVoice.hxx"
-
-#include <stdlib.h>
-
-FGATCVoice::FGATCVoice() {
- SoundData = 0;
- rawSoundData = 0;
-}
-
-FGATCVoice::~FGATCVoice() {
- if (rawSoundData)
- free( rawSoundData );
- delete SoundData;
-}
-
-// Load the two voice files - one containing the raw sound data (.wav) and one containing the word positions (.vce).
-// Return true if successful.
-bool FGATCVoice::LoadVoice(const string& voice) {
- // FIXME CLO: disabled to try to see if this is causign problemcs
- // return false;
-
- ifstream fin;
-
- SGPath path = globals->get_fg_root();
- path.append( "ATC" );
-
- string file = voice + ".wav";
-
- SoundData = new SGSoundSample();
- rawSoundData = (char *)SoundData->load_file(path.c_str(), file.c_str());
- rawDataSize = SoundData->get_size();
-
- path = globals->get_fg_root();
- string wordPath = "ATC/" + voice + ".vce";
- path.append(wordPath);
-
- // Now load the word data
- fin.open(path.c_str(), ios::in);
- if(!fin) {
- SG_LOG(SG_ATC, SG_ALERT, "Unable to open input file " << path.c_str());
- return(false);
- }
- SG_LOG(SG_ATC, SG_INFO, "Opened word data file " << wordPath << " OK...");
- char numwds[10];
- char wrd[100];
- string wrdstr;
- char wrdOffsetStr[20];
- char wrdLengthStr[20];
- unsigned int wrdOffset; // Offset into the raw sound data that the word sample begins
- unsigned int wrdLength; // Length of the word sample in bytes
- WordData wd;
- fin >> numwds;
- unsigned int numwords = atoi(numwds);
- //cout << numwords << '\n';
- for(unsigned int i=0; i < numwords; ++i) {
- fin >> wrd;
- wrdstr = wrd;
- fin >> wrdOffsetStr;
- fin >> wrdLengthStr;
- wrdOffset = atoi(wrdOffsetStr);
- wrdLength = atoi(wrdLengthStr);
- wd.offset = wrdOffset;
- wd.length = wrdLength;
- wordMap[wrdstr] = wd;
- //cout << wrd << "\t\t" << wrdOffset << "\t\t" << wrdLength << '\n';
- //cout << i << '\n';
- }
-
- fin.close();
- return(true);
-}
-
-
-typedef list < string > tokenList_type;
-typedef tokenList_type::iterator tokenList_iterator;
-
-// Given a desired message, return a pointer to the data buffer and write the buffer length into len.
-unsigned char* FGATCVoice::WriteMessage(char* message, int& len, bool& dataOK) {
-
- // What should we do here?
- // First - parse the message into a list of tokens.
- // Sort the tokens into those we understand and those we don't.
- // Add all the raw lengths of the token sound data, allocate enough space, and fill it with the rqd data.
- tokenList_type tokenList;
- tokenList_iterator tokenListItr;
-
- // TODO - at the moment we're effectively taking 3 passes through the data.
- // There is no need for this - 2 should be sufficient - we can probably ditch the tokenList.
- char* token;
- char mes[1000];
- int numWords = 0;
- strcpy(mes, message);
- const char delimiters[] = " \t.,;:\"";
- token = strtok(mes, delimiters);
- while(token != NULL) {
- tokenList.push_back(token);
- ++numWords;
- //cout << "token = " << token << '\n';
- token = strtok(NULL, delimiters);
- }
-
- WordData* wdptr = new WordData[numWords];
- int word = 0;
- unsigned int cumLength = 0;
-
- tokenListItr = tokenList.begin();
- while(tokenListItr != tokenList.end()) {
- if(wordMap.find(*tokenListItr) == wordMap.end()) {
- // Oh dear - the token isn't in the sound file
- //cout << "word " << *tokenListItr << " not found :-(\n";
- } else {
- wdptr[word] = wordMap[*tokenListItr];
- cumLength += wdptr[word].length;
- //cout << *tokenListItr << " found at offset " << wdptr[word].offset << " with length " << wdptr[word].length << endl;
- word++;
- }
- ++tokenListItr;
- }
-
- // Check for no tokens found else slScheduler can be crashed
- if(!word) {
- dataOK = false;
- return(NULL);
- }
-
- unsigned char* tmpbuf = new unsigned char[cumLength];
- unsigned char* outbuf = new unsigned char[cumLength];
- len = cumLength;
- unsigned int bufpos = 0;
- for(int i=0; i<word; ++i) {
- /*
- * Sanity check for corrupt/mismatched sound data input - avoids a seg fault
- * (As long as the calling function checks the return value!!)
- * This check should be left in even when the default Flightgear files are known
- * to be OK since it checks for mis-indexing of voice files by 3rd party developers.
- */
- if((wdptr[i].offset + wdptr[i].length) > rawDataSize) {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR - mismatch between ATC .wav and .vce file in ATCVoice.cxx\n");
- SG_LOG(SG_ATC, SG_ALERT, "Offset + length: " << wdptr[i].offset + wdptr[i].length
- << " exceeds rawdata size: " << rawDataSize << endl);
- delete[] wdptr;
- dataOK = false;
- return(NULL);
- }
- memcpy(tmpbuf + bufpos, rawSoundData + wdptr[i].offset, wdptr[i].length);
- bufpos += wdptr[i].length;
- }
-
- // tmpbuf now contains the message starting at the beginning - but we want it to start at a random position.
- unsigned int offsetIn = (int)(cumLength * sg_random());
- if(offsetIn > cumLength) offsetIn = cumLength;
- memcpy(outbuf, tmpbuf + offsetIn, (cumLength - offsetIn));
- memcpy(outbuf + (cumLength - offsetIn), tmpbuf, offsetIn);
-
- delete[] tmpbuf;
- delete[] wdptr;
-
- dataOK = true;
- return(outbuf);
-}
+++ /dev/null
-// FGATCVoice.hxx - a class to encapsulate an ATC voice
-//
-// Written by David Luff, started November 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.
-
-#ifndef _FG_ATC_VOICE
-#define _FG_ATC_VOICE
-
-#include <simgear/compiler.h>
-
-#if defined( SG_HAVE_STD_INCLUDES ) || defined( __BORLANDC__ ) || (__APPLE__)
-# include <fstream>
-# include <iostream>
-#else
-# include <fstream.h>
-# include <iostream.h>
-#endif
-
-#include <map>
-#include <list>
-#include <string>
-
-#include <simgear/sound/sample_openal.hxx>
-
-SG_USING_STD(map);
-SG_USING_STD(list);
-SG_USING_STD(string);
-
-SG_USING_STD(cout);
-SG_USING_STD(ios);
-SG_USING_STD(ofstream);
-SG_USING_STD(ifstream);
-
-
-struct WordData {
- unsigned int offset; // Offset of beginning of word sample into raw sound sample
- unsigned int length; // Byte length of word sample
-};
-
-typedef map < string, WordData > atc_word_map_type;
-typedef atc_word_map_type::iterator atc_word_map_iterator;
-typedef atc_word_map_type::const_iterator atc_word_map_const_iterator;
-
-class FGATCVoice {
-
-public:
-
- FGATCVoice();
- ~FGATCVoice();
-
- // Load the two voice files - one containing the raw sound data (.wav) and one containing the word positions (.vce).
- // Return true if successful.
- bool LoadVoice(const string& voice);
-
- // Given a desired message, return a pointer to the data buffer and write the buffer length into len.
- // Sets dataOK = true if the returned buffer is valid.
- unsigned char* WriteMessage(char* message, int& len, bool& dataOK);
-
-
-private:
-
- // the sound and word position data
- char* rawSoundData;
- unsigned int rawDataSize;
- SGSoundSample *SoundData;
-
- // A map of words vs. byte position and length in rawSoundData
- atc_word_map_type wordMap;
-
-};
-
-#endif // _FG_ATC_VOICE
+++ /dev/null
-// ATCmgr.cxx - Implementation of FGATCMgr - a global Flightgear ATC manager.
-//
-// Written by David Luff, started February 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 <simgear/misc/sg_path.hxx>
-#include <simgear/debug/logstream.hxx>
-#include <Airports/simple.hxx>
-
-#include "ATCmgr.hxx"
-#include "commlist.hxx"
-#include "ATCDialog.hxx"
-#include "ATCutils.hxx"
-#include "transmissionlist.hxx"
-#include "ground.hxx"
-
-
-/*
-// periodic radio station search wrapper
-static void fgATCSearch( void ) {
- globals->get_ATC_mgr()->Search();
-}
-*/ //This wouldn't compile - including Time/event.hxx breaks it :-(
- // Is this still true?? -EMH-
-
-AirportATC::AirportATC() :
- lon(0.0),
- lat(0.0),
- elev(0.0),
- atis_freq(0.0),
- atis_active(false),
- tower_freq(0.0),
- tower_active(false),
- ground_freq(0.0),
- ground_active(false),
- set_by_AI(false),
- numAI(0)
- //airport_atc_map.clear();
-{
- for(int i=0; i<ATC_NUM_TYPES; ++i) {
- set_by_comm[0][i] = false;
- set_by_comm[1][i] = false;
- }
-}
-
-FGATCMgr::FGATCMgr() {
- comm_ident[0] = "";
- comm_ident[1] = "";
- //last_comm_ident[0] = "";
- //last_comm_ident[1] = "";
- //approach_ident = "";
- last_in_range = false;
- comm_type[0] = INVALID;
- comm_type[1] = INVALID;
- comm_atc_ptr[0] = NULL;
- comm_atc_ptr[1] = NULL;
- comm_valid[0] = false;
- comm_valid[1] = false;
-
- initDone = false;
-}
-
-FGATCMgr::~FGATCMgr() {
- delete v1;
-}
-
-void FGATCMgr::bind() {
-}
-
-void FGATCMgr::unbind() {
-}
-
-void FGATCMgr::init() {
- //cout << "ATCMgr::init called..." << endl;
-
- comm_node[0] = fgGetNode("/instrumentation/comm[0]/frequencies/selected-mhz", true);
- comm_node[1] = fgGetNode("/instrumentation/comm[1]/frequencies/selected-mhz", true);
- lon_node = fgGetNode("/position/longitude-deg", true);
- lat_node = fgGetNode("/position/latitude-deg", true);
- elev_node = fgGetNode("/position/altitude-ft", true);
- atc_list_itr = atc_list.begin();
-
- // Search for connected ATC stations once per 0.8 seconds or so
- // globals->get_event_mgr()->add( "fgATCSearch()", fgATCSearch,
- // FGEvent::FG_EVENT_READY, 800);
- //
- // For some reason the above doesn't compile - including Time/event.hxx stops compilation.
- // Is this still true after the reorganization of the event managar??
- // -EMH-
-
- // Initialise the frequency search map
- current_commlist = new FGCommList;
- SGPath p_comm( globals->get_fg_root() );
- current_commlist->init( p_comm );
-
-#ifdef ENABLE_AUDIO_SUPPORT
- // Load all available voices.
- // For now we'll do one hardwired one
-
- v1 = new FGATCVoice;
- try {
- voiceOK = v1->LoadVoice("default");
- voice = true;
- } catch ( sg_io_exception & ) {
- voiceOK = false;
- voice = false;
- delete v1;
- v1 = 0;
- }
-
- /* I've loaded the voice even if /sim/sound/pause is true
- * since I know no way of forcing load of the voice if the user
- * subsequently switches /sim/sound/audible to true.
- * (which is the right thing to do -- CLO) :-) */
-#else
- voice = false;
-#endif
-
- // 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();
-
- initDone = true;
- //cout << "ATCmgr::init done!" << endl;
-}
-
-void FGATCMgr::update(double dt) {
- if(!initDone) {
- init();
- SG_LOG(SG_ATC, SG_WARN, "Warning - ATCMgr::update(...) called before ATCMgr::init()");
- }
-
- current_atcdialog->Update(dt);
-
- //cout << "Entering update..." << endl;
- //Traverse the list of active stations.
- //Only update one class per update step to avoid the whole ATC system having to calculate between frames.
- //Eventually we should only update every so many steps.
- //cout << "In FGATCMgr::update - atc_list.size = " << atc_list.size() << endl;
- if(atc_list.size()) {
- if(atc_list_itr == atc_list.end()) {
- atc_list_itr = atc_list.begin();
- }
- //cout << "Updating " << (*atc_list_itr)->get_ident() << ' ' << (*atc_list_itr)->GetType() << '\n';
- //cout << "Freq = " << (*atc_list_itr)->get_freq() << '\n';
- (*atc_list_itr)->Update(dt * atc_list.size());
- //cout << "Done ATC update..." << endl;
- ++atc_list_itr;
- }
-
- /*
- cout << "ATC_LIST: " << atc_list.size() << ' ';
- for(atc_list_iterator it = atc_list.begin(); it != atc_list.end(); it++) {
- cout << (*it)->get_ident() << ' ';
- }
- cout << '\n';
- */
-
- // 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.
- /*
- if(i == 7) {
- //cout << "About to AreaSearch()" << endl;
- AreaSearch();
- }
- */
- if(i == 15) {
- //cout << "About to search(1)" << endl;
- FreqSearch(1);
- }
- if(i == 30) {
- //cout << "About to search(2)" << endl;
- FreqSearch(2);
- i = 0;
- }
- ++i;
-
- //cout << "comm1 type = " << comm_type[0] << '\n';
- //cout << "Leaving update..." << endl;
-}
-
-
-// Returns frequency in KHz - should I alter this to return in MHz?
-unsigned short int FGATCMgr::GetFrequency(const string& ident, const atc_type& tp) {
- ATCData test;
- bool ok = current_commlist->FindByCode(ident, test, tp);
- return(ok ? test.freq : 0);
-}
-
-
-// Register the fact that the AI system wants to activate an airport
-// Might need more sophistication in this in the future - eg registration by aircraft call-sign.
-bool FGATCMgr::AIRegisterAirport(const string& ident) {
- SG_LOG(SG_ATC, SG_BULK, "AI registered airport " << ident << " with the ATC system");
- //cout << "AI registered airport " << ident << " with the ATC system" << '\n';
- if(airport_atc_map.find(ident) != airport_atc_map.end()) {
- airport_atc_map[ident]->set_by_AI = true;
- airport_atc_map[ident]->numAI++;
- return(true);
- } else {
- const FGAirport *ap = fgFindAirportID(ident);
- if (ap) {
- //cout << "ident = " << ident << '\n';
- AirportATC *a = new AirportATC;
- // I'm not entirely sure that this AirportATC structure business is actually needed - it just duplicates what we can find out anyway!
- a->lon = ap->getLongitude();
- a->lat = ap->getLatitude();
- a->elev = ap->getElevation();
- a->atis_freq = GetFrequency(ident, ATIS);
- //cout << "ATIS freq = " << a->atis_freq << '\n';
- a->atis_active = false;
- a->tower_freq = GetFrequency(ident, TOWER);
- //cout << "Tower freq = " << a->tower_freq << '\n';
- a->tower_active = false;
- a->ground_freq = GetFrequency(ident, GROUND);
- //cout << "Ground freq = " << a->ground_freq << '\n';
- a->ground_active = false;
- // TODO - some airports will have a tower/ground frequency but be inactive overnight.
- a->set_by_AI = true;
- a->numAI = 1;
- airport_atc_map[ident] = a;
- return(true);
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR - can't find airport " << ident << " in AIRegisterAirport(...)");
- }
- }
- return(false);
-}
-
-
-// Register the fact that the comm radio is tuned to an airport
-// Channel is zero based
-bool FGATCMgr::CommRegisterAirport(const string& ident, int chan, const atc_type& tp) {
- SG_LOG(SG_ATC, SG_BULK, "Comm channel " << chan << " registered airport " << ident);
- //cout << "Comm channel " << chan << " registered airport " << ident << ' ' << tp << '\n';
- if(airport_atc_map.find(ident) != airport_atc_map.end()) {
- //cout << "IN MAP - flagging set by comm..." << endl;
- airport_atc_map[ident]->set_by_comm[chan][tp] = true;
- if(tp == ATIS) {
- airport_atc_map[ident]->atis_active = true;
- } else if(tp == TOWER) {
- airport_atc_map[ident]->tower_active = true;
- } else if(tp == GROUND) {
- airport_atc_map[ident]->ground_active = true;
- } else if(tp == APPROACH) {
- //a->approach_active = true;
- } // TODO - there *must* be a better way to do this!!!
- return(true);
- } else {
- //cout << "NOT IN MAP - creating new..." << endl;
- const FGAirport *ap = fgFindAirportID(ident);
- if (ap) {
- AirportATC *a = new AirportATC;
- // I'm not entirely sure that this AirportATC structure business is actually needed - it just duplicates what we can find out anyway!
- a->lon = ap->getLongitude();
- a->lat = ap->getLatitude();
- a->elev = ap->getElevation();
- a->atis_freq = GetFrequency(ident, ATIS);
- a->atis_active = false;
- a->tower_freq = GetFrequency(ident, TOWER);
- a->tower_active = false;
- a->ground_freq = GetFrequency(ident, GROUND);
- a->ground_active = false;
- if(tp == ATIS) {
- a->atis_active = true;
- } else if(tp == TOWER) {
- a->tower_active = true;
- } else if(tp == GROUND) {
- a->ground_active = true;
- } else if(tp == APPROACH) {
- //a->approach_active = true;
- } // TODO - there *must* be a better way to do this!!!
- // TODO - some airports will have a tower/ground frequency but be inactive overnight.
- a->set_by_AI = false;
- a->numAI = 0;
- a->set_by_comm[chan][tp] = true;
- airport_atc_map[ident] = a;
- return(true);
- }
- }
- return(false);
-}
-
-
-// Remove from list only if not needed by the AI system or the other comm channel
-// Note that chan is zero based.
-void FGATCMgr::CommRemoveFromList(const string& id, const atc_type& tp, int chan) {
- SG_LOG(SG_ATC, SG_BULK, "CommRemoveFromList called for airport " << id << " " << tp << " by channel " << chan);
- //cout << "CommRemoveFromList called for airport " << id << " " << tp << " by channel " << chan << '\n';
- if(airport_atc_map.find(id) != airport_atc_map.end()) {
- AirportATC* a = airport_atc_map[id];
- //cout << "In CommRemoveFromList, a->ground_freq = " << a->ground_freq << endl;
- if(a->set_by_AI && tp != ATIS) {
- // Set by AI, so don't remove simply because user isn't tuned in any more - just stop displaying
- SG_LOG(SG_ATC, SG_BULK, "In CommRemoveFromList, service was set by AI\n");
- FGATC* aptr = GetATCPointer(id, tp);
- switch(chan) {
- case 0:
- //cout << "chan 1\n";
- a->set_by_comm[0][tp] = false;
- if(!a->set_by_comm[1][tp]) {
- //cout << "not set by comm2\n";
- if(aptr != NULL) {
- //cout << "Got pointer\n";
- aptr->SetNoDisplay();
- //cout << "Setting no display...\n";
- } else {
- //cout << "Not got pointer\n";
- }
- }
- break;
- case 1:
- a->set_by_comm[1][tp] = false;
- if(!a->set_by_comm[0][tp]) {
- if(aptr != NULL) {
- aptr->SetNoDisplay();
- //cout << "Setting no display...\n";
- }
- }
- break;
- }
- //airport_atc_map[id] = a;
- return;
- } else {
- switch(chan) {
- case 0:
- a->set_by_comm[0][tp] = false;
- // Remove only if not also set by the other comm channel
- if(!a->set_by_comm[1][tp]) {
- a->tower_active = false;
- a->ground_active = false;
- RemoveFromList(id, tp);
- }
- break;
- case 1:
- a->set_by_comm[1][tp] = false;
- if(!a->set_by_comm[0][tp]) {
- a->tower_active = false;
- a->ground_active = false;
- RemoveFromList(id, tp);
- }
- break;
- }
- }
- }
-}
-
-
-// Remove from list - should only be called from above or similar
-// This function *will* remove it from the list regardless of who else might want it.
-void FGATCMgr::RemoveFromList(const string& id, const atc_type& tp) {
- //cout << "FGATCMgr::RemoveFromList called..." << endl;
- //cout << "Requested type = " << tp << endl;
- //cout << "id = " << id << endl;
- atc_list_iterator it = atc_list.begin();
- while(it != atc_list.end()) {
- //cout << "type = " << (*it)->GetType() << '\n';
- //cout << "Ident = " << (*it)->get_ident() << '\n';
- if( ((*it)->get_ident() == id)
- && ((*it)->GetType() == tp) ) {
- //Before removing it stop it transmitting!!
- //cout << "OBLITERATING FROM LIST!!!\n";
- (*it)->SetNoDisplay();
- (*it)->Update(0.00833);
- delete (*it);
- atc_list.erase(it);
- atc_list_itr = atc_list.begin(); // Reset the persistent itr incase we've left it off the end.
- break;
- }
- ++it;
- }
-}
-
-
-// Find in list - return a currently active ATC pointer given ICAO code and type
-// Return NULL if the given service is not in the list
-// - *** THE CALLING FUNCTION MUST CHECK FOR THIS ***
-FGATC* FGATCMgr::FindInList(const string& id, const atc_type& tp) {
- //cout << "Entering FindInList for " << id << ' ' << tp << endl;
- atc_list_iterator it = atc_list.begin();
- while(it != atc_list.end()) {
- if( ((*it)->get_ident() == id)
- && ((*it)->GetType() == tp) ) {
- return(*it);
- }
- ++it;
- }
- // If we get here it's not in the list
- //cout << "Couldn't find it in the list though :-(" << endl;
- return(NULL);
-}
-
-// Returns true if the airport is found in the map
-bool FGATCMgr::GetAirportATCDetails(const string& icao, AirportATC* a) {
- if(airport_atc_map.find(icao) != airport_atc_map.end()) {
- *a = *airport_atc_map[icao];
- return(true);
- } else {
- return(false);
- }
-}
-
-
-// Return a pointer to a given sort of ATC at a given airport and activate if necessary
-// Returns NULL if service doesn't exist - calling function should check for this.
-// We really ought to make this private and call it from the CommRegisterAirport / AIRegisterAirport functions
-// - at the moment all these GetATC... functions exposed are just too complicated.
-FGATC* FGATCMgr::GetATCPointer(const string& icao, const atc_type& type) {
- if(airport_atc_map.find(icao) == airport_atc_map.end()) {
- //cout << "Unable to find " << icao << ' ' << type << " in the airport_atc_map" << endl;
- return NULL;
- }
- //cout << "In GetATCPointer, found " << icao << ' ' << type << endl;
- AirportATC *a = airport_atc_map[icao];
- //cout << "a->lon = " << a->lon << '\n';
- //cout << "a->elev = " << a->elev << '\n';
- //cout << "a->tower_freq = " << a->tower_freq << '\n';
- switch(type) {
- case TOWER:
- if(a->tower_active) {
- // Get the pointer from the list
- return(FindInList(icao, type));
- } else {
- ATCData data;
- if(current_commlist->FindByFreq(a->lon, a->lat, a->elev, a->tower_freq, &data, TOWER)) {
- FGTower* t = new FGTower;
- t->SetData(&data);
- atc_list.push_back(t);
- a->tower_active = true;
- airport_atc_map[icao] = a;
- //cout << "Initing tower " << icao << " in GetATCPointer()\n";
- t->Init();
- return(t);
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR - tower that should exist in FGATCMgr::GetATCPointer for airport " << icao << " not found");
- }
- }
- break;
- case APPROACH:
- break;
- case ATIS:
- SG_LOG(SG_ATC, SG_ALERT, "ERROR - ATIS station should not be requested from FGATCMgr::GetATCPointer");
- break;
- case GROUND:
- //cout << "IN CASE GROUND" << endl;
- if(a->ground_active) {
- // Get the pointer from the list
- return(FindInList(icao, type));
- } else {
- ATCData data;
- if(current_commlist->FindByFreq(a->lon, a->lat, a->elev, a->ground_freq, &data, GROUND)) {
- FGGround* g = new FGGround;
- g->SetData(&data);
- atc_list.push_back(g);
- a->ground_active = true;
- airport_atc_map[icao] = a;
- g->Init();
- return(g);
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR - ground control that should exist in FGATCMgr::GetATCPointer for airport " << icao << " not found");
- }
- }
- break;
- case INVALID:
- break;
- case ENROUTE:
- break;
- case DEPARTURE:
- break;
- }
-
- SG_LOG(SG_ATC, SG_ALERT, "ERROR IN FGATCMgr - reached end of GetATCPointer");
- //cout << "ERROR IN FGATCMgr - reached end of GetATCPointer" << endl;
-
- return(NULL);
-}
-
-// Return a pointer to an appropriate voice for a given type of ATC
-// creating the voice if necessary - ie. make sure exactly one copy
-// of every voice in use exists in memory.
-//
-// TODO - in the future this will get more complex and dole out country/airport
-// specific voices, and possible make sure that the same voice doesn't get used
-// at different airports in quick succession if a large enough selection are available.
-FGATCVoice* FGATCMgr::GetVoicePointer(const atc_type& type) {
- // TODO - implement me better - maintain a list of loaded voices and other voices!!
- if(voice) {
- switch(type) {
- case ATIS:
- if(voiceOK) {
- return(v1);
- }
- case TOWER:
- return(NULL);
- case APPROACH:
- return(NULL);
- case GROUND:
- return(NULL);
- default:
- return(NULL);
- }
- return(NULL);
- } else {
- return(NULL);
- }
-}
-
-// Search for ATC stations by frequency
-void FGATCMgr::FreqSearch(int channel) {
- int chan = channel - 1; // Convert to zero-based for the arrays
-
- ATCData data;
- double freq = comm_node[chan]->getDoubleValue();
- lon = lon_node->getDoubleValue();
- lat = lat_node->getDoubleValue();
- elev = elev_node->getDoubleValue() * SG_FEET_TO_METER;
-
- // Query the data store and get the closest match if any
- if(current_commlist->FindByFreq(lon, lat, elev, freq, &data)) {
- // We have a match
- // What's the logic?
- // If this channel not previously valid then easy - add ATC to list
- // If this channel was valid then - Have we tuned to a different service?
- // If so - de-register one and add the other
- if(comm_valid[chan]) {
- if((comm_ident[chan] == data.ident) && (comm_type[chan] == data.type)) {
- // Then we're still tuned into the same service so do nought and return
- return;
- } else {
- // Something's changed - either the location or the service type
- // We need to feed the channel in so we're not removing it if we're also tuned in on the other channel
- CommRemoveFromList(comm_ident[chan], comm_type[chan], chan);
- }
- }
- // At this point we can assume that we need to add the service.
- comm_ident[chan] = data.ident;
- comm_type[chan] = data.type;
- comm_x[chan] = (double)data.x;
- comm_y[chan] = (double)data.y;
- comm_z[chan] = (double)data.z;
- comm_lon[chan] = (double)data.lon;
- comm_lat[chan] = (double)data.lat;
- comm_elev[chan] = (double)data.elev;
- comm_valid[chan] = true;
-
- // This was a switch-case statement but the compiler didn't like the new variable creation with it.
- if(comm_type[chan] == ATIS) {
- CommRegisterAirport(comm_ident[chan], chan, ATIS);
- FGATC* app = FindInList(comm_ident[chan], ATIS);
- if(app != NULL) {
- // The station is already in the ATC list
- //cout << "In list - flagging SetDisplay..." << endl;
- comm_atc_ptr[chan] = app;
- app->SetDisplay();
- } else {
- // Generate the station and put in the ATC list
- //cout << "Not in list - generating..." << endl;
- FGATIS* a = new FGATIS;
- a->SetData(&data);
- comm_atc_ptr[chan] = a;
- a->SetDisplay();
- //a->Init();
- atc_list.push_back(a);
- }
- } else if (comm_type[chan] == TOWER) {
- //cout << "TOWER TOWER TOWER\n";
- CommRegisterAirport(comm_ident[chan], chan, TOWER);
- //cout << "Done (TOWER)" << endl;
- FGATC* app = FindInList(comm_ident[chan], TOWER);
- if(app != NULL) {
- // The station is already in the ATC list
- SG_LOG(SG_GENERAL, SG_DEBUG, comm_ident[chan] << " is in list - flagging SetDisplay...");
- //cout << comm_ident[chan] << " is in list - flagging SetDisplay...\n";
- comm_atc_ptr[chan] = app;
- app->SetDisplay();
- } else {
- // Generate the station and put in the ATC list
- SG_LOG(SG_GENERAL, SG_DEBUG, comm_ident[chan] << " is not in list - generating...");
- //cout << comm_ident[chan] << " is not in list - generating...\n";
- FGTower* t = new FGTower;
- t->SetData(&data);
- comm_atc_ptr[chan] = t;
- //cout << "Initing tower in FreqSearch()\n";
- t->Init();
- t->SetDisplay();
- atc_list.push_back(t);
- }
- } else if (comm_type[chan] == GROUND) {
- CommRegisterAirport(comm_ident[chan], chan, GROUND);
- //cout << "Done (GROUND)" << endl;
- FGATC* app = FindInList(comm_ident[chan], GROUND);
- if(app != NULL) {
- // The station is already in the ATC list
- comm_atc_ptr[chan] = app;
- app->SetDisplay();
- } else {
- // Generate the station and put in the ATC list
- FGGround* g = new FGGround;
- g->SetData(&data);
- comm_atc_ptr[chan] = g;
- g->Init();
- g->SetDisplay();
- atc_list.push_back(g);
- }
- } else if (comm_type[chan] == APPROACH) {
- // We have to be a bit more carefull here since approaches are also searched by area
- CommRegisterAirport(comm_ident[chan], chan, APPROACH);
- //cout << "Done (APPROACH)" << endl;
- FGATC* app = FindInList(comm_ident[chan], APPROACH);
- if(app != NULL) {
- // The station is already in the ATC list
- app->AddPlane("Player");
- app->SetDisplay();
- comm_atc_ptr[chan] = app;
- } else {
- // Generate the station and put in the ATC list
- FGApproach* a = new FGApproach;
- a->SetData(&data);
- comm_atc_ptr[chan] = a;
- a->Init();
- a->SetDisplay();
- a->AddPlane("Player");
- atc_list.push_back(a);
- }
- }
- } else {
- if(comm_valid[chan]) {
- if(comm_type[chan] != APPROACH) {
- // Currently approaches are removed by Alexander's out-of-range mechanism
- CommRemoveFromList(comm_ident[chan], comm_type[chan], chan);
- }
- // Note that we *don't* call SetNoDisplay() here because the other comm channel
- // might be tuned into the same station - this is handled by CommRemoveFromList(...)
- comm_type[chan] = INVALID;
- comm_atc_ptr[chan] = NULL;
- comm_valid[chan] = false;
- }
- }
-}
-
-// Search ATC stations by area in order that we appear 'on the radar'
-void FGATCMgr::AreaSearch() {
- // 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;
-
- // 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 radiostack search !!!!" << endl;
-
- for(app_itr = approaches.begin(); app_itr != approaches.end(); app_itr++) {
-
- FGATC* app = FindInList(app_itr->ident, app_itr->type);
- if(app != NULL) {
- // The station is already in the ATC list
- //cout << "In list adding player\n";
- app->AddPlane("Player");
- //app->Update();
- } else {
- // Generate the station and put in the ATC list
- FGApproach* a = new FGApproach;
- a->SetData(&(*app_itr));
- //cout << "Adding player\n";
- a->AddPlane("Player");
- //a->Update();
- atc_list.push_back(a);
- }
- }
- }
-
- // remove planes which are out of range
- // TODO - I'm not entirely sure that this belongs here.
- atc_list_iterator it = atc_list.begin();
- while(it != atc_list.end()) {
- if((*it)->GetType() == APPROACH ) {
- int np = (*it)->RemovePlane();
- // if approach has no planes left remove it from ATC list
- if ( np == 0) {
- //cout << "REMOVING AN APPROACH STATION WITH NO PLANES..." << endl;
- (*it)->SetNoDisplay();
- (*it)->Update(0.00833);
- delete (*it);
- atc_list.erase(it);
- atc_list_itr = atc_list.begin(); // Reset the persistent itr incase we've left it off the end.
- break; // the other stations will be checked next time
- }
- }
- ++it;
- }
-}
+++ /dev/null
-// ATCMgr.hxx - definition of FGATCMgr
-// - a global management class for FlightGear generated ATC
-//
-// Written by David Luff, started February 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.
-
-#ifndef _FG_ATCMGR_HXX
-#define _FG_ATCMGR_HXX
-
-#include <simgear/structure/subsystem_mgr.hxx>
-
-#include <Main/fg_props.hxx>
-#include <GUI/gui.h>
-
-#include <string>
-#include <list>
-#include <map>
-
-#include "tower.hxx"
-#include "approach.hxx"
-
-SG_USING_STD(string);
-SG_USING_STD(list);
-SG_USING_STD(map);
-
-// Structure for holding details of the ATC frequencies at a given airport, and whether they are in the active list or not.
-// These can then be cross referenced with the commlists which are stored by frequency or bucket.
-// Non-available services are denoted by a frequency of zero.
-// These structures are only intended to be created for in-use airports, and removed when no longer needed.
-struct AirportATC {
- AirportATC();
-
- float lon;
- float lat;
- float elev;
- float atis_freq;
- bool atis_active;
- float tower_freq;
- bool tower_active;
- float ground_freq;
- bool ground_active;
- //float approach_freq;
- //bool approach_active;
- //float departure_freq;
- //bool departure_active;
-
- // NOTE - the *_active flags determine whether the service is active in atc_list,
- // *NOT* whether the tower etc is closed or not!!!!
-
- // Flags to ensure the stations don't get wrongly deactivated
- bool set_by_AI; // true when the AI manager has activated this station
- unsigned int numAI; // Ref count of the number of AI planes registered
- bool set_by_comm[2][ATC_NUM_TYPES]; // true when the relevant comm_freq has activated this station and type
-};
-
-class FGATCMgr : public SGSubsystem
-{
-
-private:
-
- bool initDone; // Hack - guard against update getting called before init
-
- // A map of airport ID vs frequencies and ATC provision
- typedef map < string, AirportATC* > airport_atc_map_type;
- typedef airport_atc_map_type::iterator airport_atc_map_iterator;
- typedef airport_atc_map_type::const_iterator airport_atc_map_const_iterator;
-
- airport_atc_map_type airport_atc_map;
- airport_atc_map_iterator airport_atc_map_itr;
-
- // A list of pointers to all currently active ATC classes
- typedef list <FGATC*> atc_list_type;
- typedef atc_list_type::iterator atc_list_iterator;
- typedef atc_list_type::const_iterator atc_list_const_iterator;
-
- // Everything put in this list should be created dynamically
- // on the heap and ***DELETED WHEN REMOVED!!!!!***
- atc_list_type atc_list;
- atc_list_iterator atc_list_itr;
- // Any member function of FGATCMgr is permitted to leave this iterator pointing
- // at any point in or at the end of the list.
- // Hence any new access must explicitly first check for atc_list.end() before dereferencing.
-
- // Position of the Users Aircraft
- double lon;
- double lat;
- double elev;
-
- // Type of ATC control that the user's radios are tuned to.
- atc_type comm_type[2];
-
- // Pointer to the ATC station that the user is currently tuned into.
- FGATC* comm_atc_ptr[2];
-
- double comm_freq[2];
-
- // Pointers to users current communication frequencies.
- SGPropertyNode_ptr comm_node[2];
-
- // Pointers to current users position
- SGPropertyNode_ptr lon_node;
- SGPropertyNode_ptr lat_node;
- SGPropertyNode_ptr elev_node;
-
- // Position of the ATC that the comm radios are tuned to in order to decide
- // whether transmission will be received.
- double comm_x[2], comm_y[2], comm_z[2], comm_lon[2], comm_lat[2], comm_elev[2];
-
- double comm_range[2], comm_effective_range[2];
- bool comm_valid[2];
- string comm_ident[2];
- //string last_comm_ident[2];
- //string approach_ident;
- bool last_in_range;
-
- //FGATIS atis;
- //FGGround ground;
- FGTower tower;
- FGApproach approach;
- //FGDeparture departure;
-
- // Voice related stuff
- bool voice; // Flag - true if we are using voice
-#ifdef ENABLE_AUDIO_SUPPORT
- bool voiceOK; // Flag - true if at least one voice has loaded OK
- FGATCVoice* v1;
-#endif
-
-public:
-
- FGATCMgr();
- ~FGATCMgr();
-
- void init();
-
- void bind();
-
- void unbind();
-
- void update(double dt);
-
- // Returns true if the airport is found in the map
- bool GetAirportATCDetails(const string& icao, AirportATC* a);
-
- // Return a pointer to a given sort of ATC at a given airport and activate if necessary
- // Returns NULL if service doesn't exist - calling function should check for this.
- FGATC* GetATCPointer(const string& icao, const atc_type& type);
-
- // Return a pointer to an appropriate voice for a given type of ATC
- // creating the voice if necessary - ie. make sure exactly one copy
- // of every voice in use exists in memory.
- //
- // TODO - in the future this will get more complex and dole out country/airport
- // specific voices, and possible make sure that the same voice doesn't get used
- // at different airports in quick succession if a large enough selection are available.
- FGATCVoice* GetVoicePointer(const atc_type& type);
-
- atc_type GetComm1ATCType() { return(comm_type[0]); }
- FGATC* GetComm1ATCPointer() { return(comm_atc_ptr[0]); }
- atc_type GetComm2ATCType() { return(comm_type[1]); }
- FGATC* GetComm2ATCPointer() { return(comm_atc_ptr[1]); }
-
- // Get the frequency of a given service at a given airport
- // Returns zero if not found
- unsigned short int GetFrequency(const string& ident, const atc_type& tp);
-
- // Register the fact that the AI system wants to activate an airport
- bool AIRegisterAirport(const string& ident);
-
- // Register the fact that the comm radio is tuned to an airport
- bool CommRegisterAirport(const string& ident, int chan, const atc_type& tp);
-
-private:
-
- // Remove a class from the atc_list and delete it from memory
- // *if* no other comm channel or AI plane is using it.
- void CommRemoveFromList(const string& id, const atc_type& tp, int chan);
-
- // Remove a class from the atc_list and delete it from memory
- // Should be called from the above - not directly!!
- void RemoveFromList(const string& id, const atc_type& tp);
-
- // Return a pointer to a class in the list given ICAO code and type
- // (external interface to this is through GetATCPointer)
- // Return NULL if the given service is not in the list
- // - *** THE CALLING FUNCTION MUST CHECK FOR THIS ***
- FGATC* FindInList(const string& id, const atc_type& tp);
-
- // Search the specified channel for stations on the same frequency and in range.
- void FreqSearch(int channel);
-
- // Search ATC stations by area in order that we appear 'on the radar'
- void AreaSearch();
-
-};
-
-#endif // _FG_ATCMGR_HXX
+++ /dev/null
-// ATCutils.cxx - Utility functions for the ATC / AI system
-//
-// Written 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 <sstream>
-
-#include <math.h>
-#include <simgear/math/point3d.hxx>
-#include <simgear/constants.h>
-#include <simgear/misc/sg_path.hxx>
-#include <simgear/debug/logstream.hxx>
-#include <plib/sg.h>
-//#include <iomanip.h>
-
-#include <Airports/runways.hxx>
-#include <Main/globals.hxx>
-
-#include "ATCutils.hxx"
-#include "ATCProjection.hxx"
-
-static const string nums[10] = {"zero", "one", "two", "three", "four", "five", "six", "seven", "eight", "niner"};
-
-// Convert any number to spoken digits
-string ConvertNumToSpokenDigits(const string &n) {
- //cout << "n = " << n << endl;
- static const string pt = "decimal";
- string str = "";
-
- for(unsigned int i=0; i<n.length(); ++i) {
- //cout << "n.substr(" << i << ",1 = " << n.substr(i,1) << endl;
- if(n.substr(i,1) == " ") {
- // do nothing
- } else if(n.substr(i,1) == ".") {
- str += pt;
- } else {
- str += nums[atoi((n.substr(i,1)).c_str())];
- }
- if(i != (n.length()-1)) { // ie. don't add a space at the end.
- str += " ";
- }
- }
- return(str);
-}
-
-
-// Convert an integer to spoken digits
-string ConvertNumToSpokenDigits(int n) {
- std::ostringstream buf;
- buf << n;
- return(ConvertNumToSpokenDigits(buf.str()));
-}
-
-
-// Convert a 2 digit rwy number to a spoken-style string
-string ConvertRwyNumToSpokenString(int n) {
- // Basic error/sanity checking
- while(n < 0) {
- n += 36;
- }
- while(n > 36) {
- n -= 36;
- }
- if(n == 0) {
- n = 36; // Is this right?
- }
-
- string str = "";
- int index = n/10;
- str += nums[index];
- n -= (index * 10);
- //str += "-";
- str += " "; //Changed this for the benefit of the voice token parser - prefer the "-" in the visual output though.
- str += nums[n];
- return(str);
-}
-
-// Assumes we get a two-digit string optionally appended with L, R or C
-// eg 01 07L 29R 36
-// Anything else is not guaranteed to be handled correctly!
-string ConvertRwyNumToSpokenString(const string &s) {
- if(s.size() < 3) {
- return(ConvertRwyNumToSpokenString(atoi(s.c_str())));
- } else {
- string r = ConvertRwyNumToSpokenString(atoi(s.substr(0,2).c_str()));
- if(s.substr(2,1) == "L") {
- r += " left";
- } else if(s.substr(2,1) == "R") {
- r += " right";
- } else if(s.substr(2,1) == "C") {
- r += " center";
- } else {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Unknown suffix " << s.substr(2,1) << " from runway ID " << s << " in ConvertRwyNumToSpokenString(...)");
- }
- return(r);
- }
-}
-
-
-// Return the phonetic letter of a letter represented as an integer 1->26
-string GetPhoneticIdent(int i) {
- // TODO - Check i is between 1 and 26 and wrap if necessary
- return(GetPhoneticIdent(char('a' + (i-1))));
-}
-
-// Return the phonetic letter of a character in the range a-z or A-Z.
-// Currently always returns prefixed by lowercase.
-string GetPhoneticIdent(char c) {
- c = tolower(c);
- // TODO - Check c is between a and z and wrap if necessary
- switch(c) {
- case 'a' : return("alpha");
- case 'b' : return("bravo");
- case 'c' : return("charlie");
- case 'd' : return("delta");
- case 'e' : return("echo");
- case 'f' : return("foxtrot");
- case 'g' : return("golf");
- case 'h' : return("hotel");
- case 'i' : return("india");
- case 'j' : return("juliet");
- case 'k' : return("kilo");
- case 'l' : return("lima");
- case 'm' : return("mike");
- case 'n' : return("november");
- case 'o' : return("oscar");
- case 'p' : return("papa");
- case 'q' : return("quebec");
- case 'r' : return("romeo");
- case 's' : return("sierra");
- case 't' : return("tango");
- case 'u' : return("uniform");
- case 'v' : return("victor");
- case 'w' : return("whiskey");
- case 'x' : return("x-ray");
- case 'y' : return("yankee");
- case 'z' : return("zulu");
- }
- // We shouldn't get here
- return("Error");
-}
-
-// Get the compass direction associated with a heading in degrees
-// Currently returns 8 direction resolution (N, NE, E etc...)
-// Might be modified in future to return 4, 8 or 16 resolution but defaulting to 8.
-string GetCompassDirection(double h) {
- while(h < 0.0) h += 360.0;
- while(h > 360.0) h -= 360.0;
- if(h < 22.5 || h > 337.5) {
- return("North");
- } else if(h < 67.5) {
- return("North-East");
- } else if(h < 112.5) {
- return("East");
- } else if(h < 157.5) {
- return("South-East");
- } else if(h < 202.5) {
- return("South");
- } else if(h < 247.5) {
- return("South-West");
- } else if(h < 292.5) {
- return("West");
- } else {
- return("North-West");
- }
-}
-
-//================================================================================================================
-
-// Given two positions (lat & lon in degrees), get the HORIZONTAL separation (in meters)
-double dclGetHorizontalSeparation(const Point3D& pos1, const Point3D& pos2) {
- double x; //East-West separation
- double y; //North-South separation
- double z; //Horizontal separation - z = sqrt(x^2 + y^2)
-
- double lat1 = pos1.lat() * SG_DEGREES_TO_RADIANS;
- double lon1 = pos1.lon() * SG_DEGREES_TO_RADIANS;
- double lat2 = pos2.lat() * SG_DEGREES_TO_RADIANS;
- double lon2 = pos2.lon() * SG_DEGREES_TO_RADIANS;
-
- y = sin(fabs(lat1 - lat2)) * SG_EQUATORIAL_RADIUS_M;
- x = sin(fabs(lon1 - lon2)) * SG_EQUATORIAL_RADIUS_M * (cos((lat1 + lat2) / 2.0));
- z = sqrt(x*x + y*y);
-
- return(z);
-}
-
-// Given a point and a line, get the HORIZONTAL shortest distance from the point to a point on the line.
-// Expects to be fed orthogonal co-ordinates, NOT lat & lon !
-// The units of the separation will be those of the input.
-double dclGetLinePointSeparation(double px, double py, double x1, double y1, double x2, double y2) {
- double vecx = x2-x1;
- double vecy = y2-y1;
- double magline = sqrt(vecx*vecx + vecy*vecy);
- double u = ((px-x1)*(x2-x1) + (py-y1)*(y2-y1)) / (magline * magline);
- double x0 = x1 + u*(x2-x1);
- double y0 = y1 + u*(y2-y1);
- vecx = px - x0;
- vecy = py - y0;
- double d = sqrt(vecx*vecx + vecy*vecy);
- if(d < 0) {
- d *= -1;
- }
- return(d);
-}
-
-// Given a position (lat/lon/elev), heading and vertical angle (degrees), and distance (meters), calculate the new position.
-// This function assumes the world is spherical. If geodetic accuracy is required use the functions is sg_geodesy instead!
-// Assumes that the ground is not hit!!! Expects heading and angle in degrees, distance in meters.
-Point3D dclUpdatePosition(const Point3D& pos, double heading, double angle, double distance) {
- //cout << setprecision(10) << pos.lon() << ' ' << pos.lat() << '\n';
- heading *= DCL_DEGREES_TO_RADIANS;
- angle *= DCL_DEGREES_TO_RADIANS;
- double lat = pos.lat() * DCL_DEGREES_TO_RADIANS;
- double lon = pos.lon() * DCL_DEGREES_TO_RADIANS;
- double elev = pos.elev();
- //cout << setprecision(10) << lon*DCL_RADIANS_TO_DEGREES << ' ' << lat*DCL_RADIANS_TO_DEGREES << '\n';
-
- double horiz_dist = distance * cos(angle);
- double vert_dist = distance * sin(angle);
-
- double north_dist = horiz_dist * cos(heading);
- double east_dist = horiz_dist * sin(heading);
-
- //cout << distance << ' ' << horiz_dist << ' ' << vert_dist << ' ' << north_dist << ' ' << east_dist << '\n';
-
- double delta_lat = asin(north_dist / (double)SG_EQUATORIAL_RADIUS_M);
- double delta_lon = asin(east_dist / (double)SG_EQUATORIAL_RADIUS_M) * (1.0 / cos(lat)); // I suppose really we should use the average of the original and new lat but we'll assume that this will be good enough.
- //cout << delta_lon*DCL_RADIANS_TO_DEGREES << ' ' << delta_lat*DCL_RADIANS_TO_DEGREES << '\n';
- lat += delta_lat;
- lon += delta_lon;
- elev += vert_dist;
- //cout << setprecision(10) << lon*DCL_RADIANS_TO_DEGREES << ' ' << lat*DCL_RADIANS_TO_DEGREES << '\n';
-
- //cout << setprecision(15) << DCL_DEGREES_TO_RADIANS * DCL_RADIANS_TO_DEGREES << '\n';
-
- return(Point3D(lon*DCL_RADIANS_TO_DEGREES, lat*DCL_RADIANS_TO_DEGREES, elev));
-}
-
-// Get a heading in degrees from one lat/lon to another.
-// This function assumes the world is spherical. If geodetic accuracy is required use the functions is sg_geodesy instead!
-// Warning - at the moment we are not checking for identical points - currently it returns 0 in this instance.
-double GetHeadingFromTo(const Point3D& A, const Point3D& B) {
- double latA = A.lat() * DCL_DEGREES_TO_RADIANS;
- double lonA = A.lon() * DCL_DEGREES_TO_RADIANS;
- double latB = B.lat() * DCL_DEGREES_TO_RADIANS;
- double lonB = B.lon() * DCL_DEGREES_TO_RADIANS;
- double xdist = sin(lonB - lonA) * (double)SG_EQUATORIAL_RADIUS_M * cos((latA+latB)/2.0);
- double ydist = sin(latB - latA) * (double)SG_EQUATORIAL_RADIUS_M;
- double heading = atan2(xdist, ydist) * DCL_RADIANS_TO_DEGREES;
- return heading < 0.0 ? heading + 360 : heading;
-}
-
-// Given a heading (in degrees), bound it from 0 -> 360
-void dclBoundHeading(double &hdg) {
- while(hdg < 0.0) {
- hdg += 360.0;
- }
- while(hdg > 360.0) {
- hdg -= 360.0;
- }
-}
-
-// smallest difference between two angles in degrees
-// difference is negative if a1 > a2 and positive if a2 > a1
-double GetAngleDiff_deg( const double &a1, const double &a2) {
-
- double a3 = a2 - a1;
- while (a3 < 180.0) a3 += 360.0;
- while (a3 > 180.0) a3 -= 360.0;
-
- return a3;
-}
-
-// Runway stuff
-// Given a Point3D (lon/lat/elev) and an FGRunway struct, determine if the point lies on the runway
-bool OnRunway(const Point3D& pt, const FGRunway& rwy) {
- FGATCAlignedProjection ortho;
- Point3D centre(rwy._lon, rwy._lat, 0.0); // We don't need the elev
- ortho.Init(centre, rwy._heading);
-
- Point3D xyc = ortho.ConvertToLocal(centre);
- Point3D xyp = ortho.ConvertToLocal(pt);
-
- //cout << "Length offset = " << fabs(xyp.y() - xyc.y()) << '\n';
- //cout << "Width offset = " << fabs(xyp.x() - xyc.x()) << '\n';
-
- if((fabs(xyp.y() - xyc.y()) < ((rwy._length/2.0) + 5.0))
- && (fabs(xyp.x() - xyc.x()) < (rwy._width/2.0))) {
- return(true);
- }
-
- return(false);
-}
-
+++ /dev/null
-// ATCutils.hxx - Utility functions for the ATC / AI subsytem
-//
-// Written 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.
-
-#include <Airports/simple.hxx>
-#include <Airports/runways.hxx>
-
-#include <math.h>
-#include <simgear/math/point3d.hxx>
-#include <string>
-SG_USING_STD(string);
-
-// These are defined here because I had a problem with SG_DEGREES_TO_RADIANS
-#define DCL_PI 3.1415926535f
-#define DCL_DEGREES_TO_RADIANS (DCL_PI/180.0)
-#define DCL_RADIANS_TO_DEGREES (180.0/DCL_PI)
-
-/*******************************
-*
-* Communication functions
-*
-********************************/
-
-// Convert any number to spoken digits
-string ConvertNumToSpokenDigits(const string &n);
-
-// Convert an integer to spoken digits
-string ConvertNumToSpokenDigits(int n);
-
-// Convert a 2 digit rwy number to a spoken-style string
-string ConvertRwyNumToSpokenString(int n);
-
-// Convert rwy number string to a spoken-style string
-// eg "05L" to "zero five left"
-// Assumes we get a two-digit string optionally appended with R, L, or C
-// eg 01 07L 29R 36
-// Anything else is not guaranteed to be handled correctly!
-string ConvertRwyNumToSpokenString(const string &s);
-
-// Return the phonetic letter of a letter represented as an integer 1->26
-string GetPhoneticIdent(int i);
-
-// Return the phonetic letter of a character in the range a-z or A-Z.
-// Currently always returns prefixed by lowercase.
-string GetPhoneticIdent(char c);
-
-// Get the compass direction associated with a heading in degrees
-// Currently returns 8 direction resolution (N, NE, E etc...)
-// Might be modified in future to return 4, 8 or 16 resolution but defaulting to 8.
-string GetCompassDirection(double h);
-
-/*******************************
-*
-* Positional functions
-*
-********************************/
-
-// Given two positions (lat & lon in degrees), get the HORIZONTAL separation (in meters)
-double dclGetHorizontalSeparation(const Point3D& pos1, const Point3D& pos2);
-
-// Given a point and a line, get the HORIZONTAL shortest distance from the point to a point on the line.
-// Expects to be fed orthogonal co-ordinates, NOT lat & lon !
-double dclGetLinePointSeparation(double px, double py, double x1, double y1, double x2, double y2);
-
-// Given a position (lat/lon/elev), heading, vertical angle, and distance, calculate the new position.
-// Assumes that the ground is not hit!!! Expects heading and angle in degrees, distance in meters.
-Point3D dclUpdatePosition(const Point3D& pos, double heading, double angle, double distance);
-
-// Get a heading from one lat/lon to another (in degrees)
-double GetHeadingFromTo(const Point3D& A, const Point3D& B);
-
-// Given a heading (in degrees), bound it from 0 -> 360
-void dclBoundHeading(double &hdg);
-
-// smallest difference between two angles in degrees
-// difference is negative if a1 > a2 and positive if a2 > a1
-double GetAngleDiff_deg( const double &a1, const double &a2);
-
-/****************
-*
-* Runways
-*
-****************/
-
-// Given a Point3D (lon/lat/elev) and an FGRunway struct, determine if the point lies on the runway
-bool OnRunway(const Point3D& pt, const FGRunway& rwy);
-
+++ /dev/null
-noinst_LIBRARIES = libATC.a
-
-libATC_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 \
- AIMgr.hxx AIMgr.cxx \
- AIEntity.hxx AIEntity.cxx \
- AIPlane.hxx AIPlane.cxx \
- AILocalTraffic.hxx AILocalTraffic.cxx \
- AIGAVFRTraffic.hxx AIGAVFRTraffic.cxx \
- transmission.hxx transmission.cxx \
- transmissionlist.hxx transmissionlist.cxx
-
-INCLUDES = -I$(top_srcdir) -I$(top_srcdir)/src
+++ /dev/null
-// 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 "approach.hxx"
-#include "transmission.hxx"
-#include "transmissionlist.hxx"
-#include "ATCDialog.hxx"
-
-#include <Airports/runways.hxx>
-#include <simgear/constants.h>
-#include <simgear/math/polar3d.hxx>
-#include <simgear/misc/sg_path.hxx>
-
-#include <Environment/environment_mgr.hxx>
-#include <Environment/environment.hxx>
-
-
-#include <GUI/gui.h>
-
-//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;
-
- int wpn = planes[i].wpn;
- // waypoint 0: Threshold of active runway
- calc_gc_course_dist(Point3D(lon*SGD_DEGREES_TO_RADIANS, lat*SGD_DEGREES_TO_RADIANS, 0.0),
- Point3D(active_rw_lon*SGD_DEGREES_TO_RADIANS,active_rw_lat*SGD_DEGREES_TO_RADIANS, 0.0 ),
- &course, &d);
- double d1 = active_rw_hdg+180.0;
- if ( d1 > 360.0 ) d1 -=360.0;
- calc_cd_head_dist(360.0-course*SGD_RADIANS_TO_DEGREES, 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] = elev;
- 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 = elev+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";
-
- FGEnvironment stationweather =
- ((FGEnvironmentMgr *)globals->get_subsystem("environment"))
- ->getEnvironment(lat, lon, elev);
-
- double hdg = stationweather.get_wind_from_heading_deg();
-
- FGRunway runway;
- if ( globals->get_runways()->search( ident, int(hdg), &runway) ) {
- active_runway = runway._rwy_no;
- active_rw_hdg = runway._heading;
- active_rw_lon = runway._lon;
- active_rw_lat = runway._lat;
- active_rw_len = runway._length;
- //cout << "Active runway is: " << active_runway << " heading = "
- // << active_rw_hdg
- // << " lon = " << active_rw_lon
- // << " lat = " << active_rw_lat <<endl;
- }
- else cout << "FGRunways search failed\n";
-
-}
-
-// ========================================================================
-// 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();
-
- /*Point3D aircraft = sgGeodToCart( Point3D(planes[i].lon*SGD_DEGREES_TO_RADIANS,
- planes[i].lat*SGD_DEGREES_TO_RADIANS,
- planes[i].alt*SG_FEET_TO_METER) );*/
- double course, distance;
- calc_gc_course_dist(Point3D(lon*SGD_DEGREES_TO_RADIANS, lat*SGD_DEGREES_TO_RADIANS, 0.0),
- Point3D(planes[i].lon*SGD_DEGREES_TO_RADIANS,planes[i].lat*SGD_DEGREES_TO_RADIANS, 0.0 ),
- &course, &distance);
- planes[i].dist = distance/SG_NM_TO_METER;
- planes[i].brg = 360.0-course*SGD_RADIANS_TO_DEGREES;
-
- //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());
-}
-
+++ /dev/null
-// 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>
-
-#ifdef SG_HAVE_STD_INCLUDES
-# include <istream>
-#include <iomanip>
-#elif defined( SG_HAVE_NATIVE_SGI_COMPILERS )
-# include <iostream.h>
-#elif defined( __BORLANDC__ )
-# include <iostream>
-#else
-# include <istream.h>
-#include <iomanip.h>
-#endif
-
-#if ! defined( SG_HAVE_NATIVE_SGI_COMPILERS )
-SG_USING_STD(istream);
-#endif
-
-SG_USING_STD(string);
-
-#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
- 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;
-
- 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
- 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
- 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 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 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 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 istream& operator>> ( istream&, FGApproach& );
-};
-
-#endif // _FG_APPROACH_HXX
+++ /dev/null
-// atis.cxx - routines to generate the ATIS info string
-// This is the implementation of the FGATIS class
-//
-// Written by David Luff, started October 2001.
-//
-// 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.
-
-
-#ifdef HAVE_CONFIG_H
-# include <config.h>
-#endif
-
-#include <simgear/compiler.h>
-
-#include <stdlib.h> // atoi()
-#include <stdio.h> // sprintf
-#include <string>
-SG_USING_STD(string);
-
-#include STL_IOSTREAM
-SG_USING_STD(cout);
-
-#include <simgear/misc/sg_path.hxx>
-
-#include <Environment/environment_mgr.hxx>
-#include <Environment/environment.hxx>
-
-#include <Main/fg_props.hxx>
-#include <Main/globals.hxx>
-#include <Airports/runways.hxx>
-
-#include "atis.hxx"
-#include "commlist.hxx"
-#include "ATCutils.hxx"
-#include "ATCmgr.hxx"
-
-FGATIS::FGATIS() :
- transmission(""),
- trans_ident(""),
- atis_failed(false),
- refname("atis")
- //type(ATIS)
-{
- _vPtr = globals->get_ATC_mgr()->GetVoicePointer(ATIS);
- _voiceOK = (_vPtr == NULL ? false : true);
- _type = ATIS;
-}
-
-FGATIS::~FGATIS() {
-}
-
-// Main update function - checks whether we are displaying or not the correct message.
-void FGATIS::Update(double dt) {
- if(_display) {
- if(_displaying) {
- // Check if we need to update the message
- // - basically every hour and if the weather changes significantly at the station
- } else {
- // We need to get and display the message
- UpdateTransmission();
- //cout << "ATIS.CXX - calling ATCMgr to render transmission..." << endl;
- Render(transmission, refname, true);
- _displaying = true;
- }
- } else {
- // We shouldn't be displaying
- if(_displaying) {
- //cout << "ATIS.CXX - calling NoRender()..." << endl;
- NoRender(refname);
- _displaying = false;
- }
- }
-}
-
-// Sets the actual broadcast ATIS transmission.
-void FGATIS::UpdateTransmission() {
- double visibility;
- char buf[10];
- int phonetic_id;
- string phonetic_id_string;
- string time_str = fgGetString("sim/time/gmt-string");
- int hours;
- // int minutes;
-
- FGEnvironment stationweather =
- ((FGEnvironmentMgr *)globals->get_subsystem("environment"))
- ->getEnvironment(lat, lon, 0.0);
-
- transmission = "";
-
- // UK CAA radiotelephony manual indicated ATIS transmissions start with "This is"
- // Not sure about rest of the world though.
- transmission += "This_is ";
- // transmitted station name.
- transmission += name;
- // Add "Information"
- transmission += " information";
-
- //cout << "In atis.cxx, time_str = " << time_str << '\n';
- // Add the recording identifier
- // For now we will assume we only transmit every hour
- hours = atoi((time_str.substr(1,2)).c_str()); //Warning - this is fragile if the
- //time string format changes
- //cout << "In atis.cxx, hours = " << hours << endl;
- phonetic_id = current_commlist->GetCallSign(ident, hours, 0);
- phonetic_id_string = GetPhoneticIdent(phonetic_id);
- transmission += " ";
- transmission += phonetic_id_string;
-
- // Output the recording time. - we'll just output the last whole hour for now.
- // FIXME - this only gets GMT time but that appears to be all the clock outputs for now
- //cout << "in atis.cxx, time = " << time_str << endl;
- transmission = transmission + " / Weather " + ConvertNumToSpokenDigits((time_str.substr(0,3) + "00")) + " hours zulu";
-
- // Get the temperature
- int temp;
- temp = (int)stationweather.get_temperature_degc();
-
- // HACK ALERT - at the moment the new environment subsystem returns bogus temperatures
- // FIXME - take out this hack when this gets fixed upstream
- if((temp < -50) || (temp > 60)) {
- temp = 15;
- }
-
- sprintf(buf, "%i", abs(temp));
- transmission += " / Temperature ";
- if(temp < 0) {
- transmission += "minus ";
- }
- string tempstr1 = buf;
- string tempstr2;
- transmission += ConvertNumToSpokenDigits(tempstr1);
- transmission += " degrees_Celsius";
-
- // Get the visibility
- visibility = stationweather.get_visibility_m();
- sprintf(buf, "%i", int(visibility/1600));
- transmission += " / Visibility ";
- tempstr1 = buf;
- transmission += ConvertNumToSpokenDigits(tempstr1);
- transmission += " miles";
-
- // Get the cloudbase
- // FIXME: kludge for now
- if (strcmp(fgGetString("/environment/clouds/layer[0]/type"), "clear")) {
- double cloudbase =
- fgGetDouble("/environment/clouds/layer[0]/elevation-ft");
- // For some reason the altitude returned doesn't seem to correspond to the actual cloud altitude.
- char buf3[10];
- char buf4[10];
- // cout << "cloudbase = " << cloudbase << endl;
- sprintf(buf3, "%i", int(cloudbase)/1000);
- sprintf(buf4, "%i", ((int)cloudbase % 1000)/100);
- transmission += " / Cloudbase";
- if(int(cloudbase)/1000) {
- tempstr1 = buf3;
- transmission = transmission + " " + ConvertNumToSpokenDigits(tempstr1) + " thousand";
- }
- if(((int)cloudbase % 1000)/100) {
- tempstr1 = buf4;
- transmission = transmission + " " + ConvertNumToSpokenDigits(tempstr1) + " hundred";
- }
- transmission += " feet";
- }
-
- // Get the pressure / altimeter
- double P = fgGetDouble("/environment/pressure-sea-level-inhg");
- if(ident.substr(0,2) == "EG" && fgGetBool("/sim/atc/use-millibars") == true) {
- // Convert to millibars for the UK!
- P *= 33.864;
- sprintf(buf, "%.0f", P);
- } else {
- sprintf(buf, "%.2f", P);
- }
- transmission += " / Altimeter ";
- tempstr1 = buf;
- transmission += ConvertNumToSpokenDigits(tempstr1);
-
- // Based on the airport-id and wind get the active runway
- //FGRunway *r;
- double speed = stationweather.get_wind_speed_kt();
- double hdg = stationweather.get_wind_from_heading_deg();
- if (speed == 0) {
- hdg = 270; // This forces West-facing rwys to be used in no-wind situations
- // which is consistent with Flightgear's initial setup.
- transmission += " / Winds_light_and_variable";
- } else {
- // FIXME: get gust factor in somehow
- char buf5[10];
- char buf6[10];
- sprintf(buf5, "%i", int(speed));
- sprintf(buf6, "%i", int(hdg));
- tempstr1 = buf5;
- tempstr2 = buf6;
- transmission = transmission + " / Winds " + ConvertNumToSpokenDigits(tempstr1) + " knots from "
- + ConvertNumToSpokenDigits(tempstr2) + " degrees";
- }
-
- string rwy_no = globals->get_runways()->search(ident, int(hdg));
- if(rwy_no != "NN") {
- transmission += " / Landing_and_departing_runway ";
- transmission += ConvertRwyNumToSpokenString(atoi(rwy_no.c_str()));
- //cout << "in atis.cxx, r.rwy_no = " << rwy_no << " r.id = " << r->id << " r.heading = " << r->heading << endl;
- }
-
- // Anything else?
-
- transmission += " / Advise_controller_on_initial_contact_you_have ";
- transmission += phonetic_id_string;
- transmission += " /// ";
-}
+++ /dev/null
-// atis.hxx -- ATIS class
-//
-// Written by David Luff, started October 2001.
-// 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_ATIS_HXX
-#define _FG_ATIS_HXX
-
-#include <stdio.h>
-#include <string>
-
-#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>
-
-#ifdef SG_HAVE_STD_INCLUDES
-# include <istream>
-# include <iomanip>
-#elif defined( __BORLANDC__ ) || (__APPLE__)
-# include <iostream>
-#else
-# include <istream.h>
-# include <iomanip.h>
-#endif
-
-SG_USING_STD(istream);
-SG_USING_STD(string);
-
-#include "ATC.hxx"
-
-//DCL - a complete guess for now.
-#define FG_ATIS_DEFAULT_RANGE 30
-
-class FGATIS : public FGATC {
-
- //atc_type type;
- string transmission; // The actual ATIS transmission
- // This is not stored in default.atis but is generated
- // from the prevailing conditions when required.
-
- // for failure modeling
- string trans_ident; // transmitted ident
- bool atis_failed; // atis failed?
-
- // Aircraft position
- // ATIS is actually a special case in that unlike other ATC eg.tower it doesn't actually know about
- // or the whereabouts of the aircraft it is transmitting to. However, to ensure consistancy of
- // operation with the other ATC classes the ATIS class must calculate range to the aircraft in order
- // to decide whether to render the transmission - hence the users plane details must be stored.
- //SGPropertyNode_ptr airplane_lon_node;
- //SGPropertyNode_ptr airplane_lat_node;
- //SGPropertyNode_ptr airplane_elev_node;
-
- public:
-
- FGATIS(void);
- ~FGATIS(void);
-
- //run the ATIS instance
- void Update(double dt);
-
- //inline void set_type(const atc_type tp) {type = tp;}
- inline const string& get_trans_ident() { return trans_ident; }
- inline void set_refname(const string& r) { refname = r; }
-
- private:
-
- string refname; // Holds the refname of a transmission in progress
-
- //Update the transmission string
- void UpdateTransmission(void);
-
- friend istream& operator>> ( istream&, FGATIS& );
-};
-
-#endif // _FG_ATIS_HXX
+++ /dev/null
-// commlist.cxx -- comm frequency lookup class
-//
-// Written by David Luff and Alexander Kappes, started Jan 2003.
-// 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.
-
-
-#ifdef HAVE_CONFIG_H
-# include <config.h>
-#endif
-
-#include <simgear/debug/logstream.hxx>
-#include <simgear/misc/sgstream.hxx>
-#include <simgear/math/sg_geodesy.hxx>
-#include <simgear/math/sg_random.h>
-#include <simgear/bucket/newbucket.hxx>
-#include <Airports/simple.hxx>
-
-#include "commlist.hxx"
-//#include "atislist.hxx"
-#include "ATCutils.hxx"
-
-
-FGCommList *current_commlist;
-
-
-// Constructor
-FGCommList::FGCommList( void ) {
-}
-
-
-// Destructor
-FGCommList::~FGCommList( void ) {
-}
-
-
-// load the navaids and build the map
-bool FGCommList::init( const SGPath& path ) {
-
- SGPath temp = path;
- commlist_freq.erase(commlist_freq.begin(), commlist_freq.end());
- commlist_bck.erase(commlist_bck.begin(), commlist_bck.end());
- temp.append( "ATC/default.atis" );
- LoadComms(temp);
- temp = path;
- temp.append( "ATC/default.tower" );
- LoadComms(temp);
- temp = path;
- temp.append( "ATC/default.ground" );
- LoadComms(temp);
- temp = path;
- temp.append( "ATC/default.approach" );
- LoadComms(temp);
- return true;
-}
-
-
-bool FGCommList::LoadComms(const SGPath& path) {
-
- sg_gzifstream fin( path.str() );
- if ( !fin.is_open() ) {
- SG_LOG( SG_GENERAL, SG_ALERT, "Cannot open file: " << path.str() );
- exit(-1);
- }
-
- // read in each line of the file
- fin >> skipcomment;
-
-#ifdef __MWERKS__
- char c = 0;
- while ( fin.get(c) && c != '\0' ) {
- fin.putback(c);
-#else
- while ( !fin.eof() ) {
-#endif
- ATCData a;
- fin >> a;
- if(a.type == INVALID) {
- SG_LOG(SG_GENERAL, SG_DEBUG, "WARNING - INVALID type found in " << path.str() << '\n');
- } else {
- // Push all stations onto frequency map
- commlist_freq[a.freq].push_back(a);
-
- // Push non-atis stations onto bucket map as well
- // In fact, push all stations onto bucket map for now so FGATCMgr::GetFrequency() works.
- //if(a.type != ATIS) {
- // get bucket number
- SGBucket bucket(a.lon, a.lat);
- int bucknum = bucket.gen_index();
- commlist_bck[bucknum].push_back(a);
- //}
- }
-
- fin >> skipcomment;
- }
-
- fin.close();
- return true;
-}
-
-
-// query the database for the specified frequency, lon and lat are in
-// degrees, elev is in meters
-// If no atc_type is specified, it returns true if any non-invalid type is found
-// If atc_type is specifed, returns true only if the specified type is found
-bool FGCommList::FindByFreq( double lon, double lat, double elev, double freq,
- ATCData* ad, atc_type tp )
-{
- lon *= SGD_DEGREES_TO_RADIANS;
- lat *= SGD_DEGREES_TO_RADIANS;
-
- // HACK - if freq > 1000 assume it's in KHz, otherwise assume MHz.
- // A bit ugly but it works for now!!!!
- comm_list_type stations;
- if(freq > 1000.0) {
- stations = commlist_freq[(int)freq];
- } else {
- stations = commlist_freq[(int)(freq*100.0 + 0.5)];
- }
- comm_list_iterator current = stations.begin();
- comm_list_iterator last = stations.end();
-
- // double az1, az2, s;
- Point3D aircraft = sgGeodToCart( Point3D(lon, lat, elev) );
- Point3D station;
- const double orig_max_d = 1e100;
- double max_d = orig_max_d;
- double d;
- // TODO - at the moment this loop returns the first match found in range
- // We want to return the closest match in the event of a frequency conflict
- for ( ; current != last ; ++current ) {
- //cout << "testing " << current->get_ident() << endl;
- station = Point3D(current->x, current->y, current->z);
- //cout << "aircraft = " << aircraft << endl;
- //cout << "station = " << station << endl;
-
- d = aircraft.distance3Dsquared( station );
-
- //cout << " dist = " << sqrt(d)
- // << " range = " << current->range * SG_NM_TO_METER << endl;
-
- // TODO - match up to twice the published range so we can model
- // reduced signal strength
- // NOTE The below is squared since we match to distance3Dsquared (above) to avoid a sqrt.
- if ( d < (current->range * SG_NM_TO_METER
- * current->range * SG_NM_TO_METER ) ) {
- //cout << "matched = " << current->ident << endl;
- if((tp == INVALID) || (tp == (*current).type)) {
- if(d < max_d) {
- max_d = d;
- *ad = *current;
- }
- }
- }
- }
-
- if(max_d < orig_max_d) {
- return true;
- } else {
- return false;
- }
-}
-
-int FGCommList::FindByPos(double lon, double lat, double elev, double range, comm_list_type* stations, atc_type tp)
-{
- // number of relevant stations found within range
- int found = 0;
- stations->erase(stations->begin(), stations->end());
-
- // get bucket number for plane position
- SGBucket buck(lon, lat);
-
- // get neigboring buckets
- int bx = (int)( range*SG_NM_TO_METER / buck.get_width_m() / 2);
- int by = (int)( range*SG_NM_TO_METER / buck.get_height_m() / 2 );
-
- // loop over bucket range
- for ( int i=-bx; i<=bx; i++) {
- for ( int j=-by; j<=by; j++) {
- buck = sgBucketOffset(lon, lat, i, j);
- long int bucket = buck.gen_index();
- comm_list_type Fstations = commlist_bck[bucket];
- comm_list_iterator current = Fstations.begin();
- comm_list_iterator last = Fstations.end();
-
- double rlon = lon * SGD_DEGREES_TO_RADIANS;
- double rlat = lat * SGD_DEGREES_TO_RADIANS;
-
- // double az1, az2, s;
- Point3D aircraft = sgGeodToCart( Point3D(rlon, rlat, elev) );
- Point3D station;
- double d;
- for(; current != last; ++current) {
- if((current->type == tp) || (tp == INVALID)) {
- station = Point3D(current->x, current->y, current->z);
- d = aircraft.distance3Dsquared( station );
- // NOTE The below is squared since we match to distance3Dsquared (above) to avoid a sqrt.
- if ( d < (current->range * SG_NM_TO_METER
- * current->range * SG_NM_TO_METER ) ) {
- stations->push_back(*current);
- ++found;
- }
- }
- }
- }
- }
- return found;
-}
-
-
-// Returns the distance in meters to the closest station of a given type,
-// with the details written into ATCData& ad. If no type is specifed simply
-// returns the distance to the closest station of any type.
-// Returns -9999 if no stations found within max_range in nautical miles (default 100 miles).
-// Note that the search algorithm starts at 10 miles and multiplies by 10 thereafter, so if
-// say 300 miles is specifed 10, then 100, then 1000 will be searched, breaking at first result
-// and giving up after 1000.
-double FGCommList::FindClosest( double lon, double lat, double elev, ATCData& ad, atc_type tp, double max_range) {
- int num_stations = 0;
- int range = 10;
- comm_list_type stations;
- comm_list_iterator itr;
- double distance = -9999.0;
-
- while(num_stations == 0) {
- num_stations = FindByPos(lon, lat, elev, range, &stations, tp);
- if(num_stations) {
- double closest = max_range * SG_NM_TO_METER;
- double tmp;
- for(itr = stations.begin(); itr != stations.end(); ++itr) {
- ATCData ad2 = *itr;
- //Point3D p1(*itr.lon, *itr.lat, *itr.elev);
- Point3D p1(ad2.lon, ad2.lat, ad2.elev);
- const FGAirport *a = fgFindAirportID(ad2.ident);
- if (a) {
- Point3D p2(lon, lat, elev);
- tmp = dclGetHorizontalSeparation(p1, p2);
- if(tmp <= closest) {
- closest = tmp;
- distance = tmp;
- ad = *itr;
- }
- }
- }
- //cout << "Closest station is " << ad.ident << " at a range of " << distance << " meters\n";
- return(distance);
- }
- if(range > max_range) {
- break;
- }
- range *= 10;
- }
- return(-9999.0);
-}
-
-
-// Find by Airport code.
-// This is basically a wrapper for a call to the airport database to get the airport
-// position followed by a call to FindByPos(...)
-bool FGCommList::FindByCode( const string& ICAO, ATCData& ad, atc_type tp ) {
- const FGAirport *a = fgFindAirportID( ICAO);
- if ( a) {
- comm_list_type stations;
- int found = FindByPos(a->getLongitude(), a->getLatitude(), a->getElevation(), 10.0, &stations, tp);
- if(found) {
- comm_list_iterator itr = stations.begin();
- while(itr != stations.end()) {
- if(((*itr).ident == ICAO) && ((*itr).type == tp)) {
- ad = *itr;
- return true;
- }
- ++itr;
- }
- }
- } else {
- return false;
- }
- return false;
-}
-
-
-// TODO - this function should move somewhere else eventually!
-// Return an appropriate call-sign for an ATIS transmission.
-int FGCommList::GetCallSign( const string& apt_id, int hours, int mins )
-{
- atis_transmission_type tran;
-
- if(atislog.find(apt_id) == atislog.end()) {
- // This station has not transmitted yet - return a random identifier
- // and add the transmission to the log
- tran.hours = hours;
- tran.mins = mins;
- sg_srandom_time();
- tran.callsign = int(sg_random() * 25) + 1; // This *should* give a random int between 1 and 26
- //atislog[apt_id].push_back(tran);
- atislog[apt_id] = tran;
- } else {
- // This station has transmitted - calculate the appropriate identifier
- // and add the transmission to the log if it has changed
- tran = atislog[apt_id];
- // This next bit assumes that no-one comes back to the same ATIS station
- // after running FlightGear for more than 24 hours !!
- if((tran.hours == hours) && (tran.mins == mins)) {
- return(tran.callsign);
- } else {
- if(tran.hours == hours) {
- // The minutes must have changed
- tran.mins = mins;
- tran.callsign++;
- } else {
- if(hours < tran.hours) {
- hours += 24;
- }
- tran.callsign += (hours - tran.hours);
- if(mins != 0) {
- // Assume transmissions were made on every hour
- tran.callsign++;
- }
- tran.hours = hours;
- tran.mins = mins;
- }
- // Wrap if we've exceeded Zulu
- if(tran.callsign > 26) {
- tran.callsign -= 26;
- }
- // And write the new transmission to the log
- atislog[apt_id] = tran;
- }
- }
- return(tran.callsign);
-}
+++ /dev/null
-// commlist.hxx -- comm frequency lookup class
-//
-// Written by David Luff and Alexander Kappes, started Jan 2003.
-// 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.
-
-/*****************************************************************
-*
-* FGCommList is used to store communication frequency information
-* for the ATC and AI subsystems. Two maps are maintained - one
-* searchable by location and one searchable by frequency. The
-* data structure returned from the search is the ATCData struct
-* defined in ATC.hxx, containing location, frequency, name, range
-* and type of the returned station.
-*
-******************************************************************/
-
-#ifndef _FG_COMMLIST_HXX
-#define _FG_COMMLIST_HXX
-
-
-#include <simgear/compiler.h>
-#include <simgear/misc/sg_path.hxx>
-
-#include <map>
-#include <list>
-#include <string>
-
-#include "ATC.hxx"
-#include "atis.hxx"
-
-SG_USING_STD(list);
-SG_USING_STD(map);
-SG_USING_STD(vector);
-SG_USING_STD(string);
-
-// A list of ATC stations
-typedef list < ATCData > comm_list_type;
-typedef comm_list_type::iterator comm_list_iterator;
-typedef comm_list_type::const_iterator comm_list_const_iterator;
-
-// A map of ATC station lists
-typedef map < int, comm_list_type > comm_map_type;
-typedef comm_map_type::iterator comm_map_iterator;
-typedef comm_map_type::const_iterator comm_map_const_iterator;
-
-
-class FGCommList {
-
-public:
-
- FGCommList();
- ~FGCommList();
-
- // load all comm frequencies and build the map
- bool init( const SGPath& path );
-
- // query the database for the specified frequency, lon and lat are
- // in degrees, elev is in meters.
- // If no atc_type is specified, it returns true if any non-invalid type is found.
- // If atc_type is specifed, returns true only if the specified type is found.
- // Returns the station closest to the supplied position.
- // The data found is written into the passed-in ATCData structure.
- bool FindByFreq( double lon, double lat, double elev, double freq, ATCData* ad, atc_type tp = INVALID );
-
- // query the database by location, lon and lat are in degrees, elev is in meters, range is in nautical miles.
- // Returns the number of stations of the specified atc_type tp that are in range of the position defined by
- // lon, lat and elev, and pushes them into stations.
- // If no atc_type is specifed, returns the number of all stations in range, and pushes them into stations
- // ** stations is erased before use **
- int FindByPos( double lon, double lat, double elev, double range, comm_list_type* stations, atc_type tp = INVALID );
-
- // Returns the distance in meters to the closest station of a given type,
- // with the details written into ATCData& ad. If no type is specifed simply
- // returns the distance to the closest station of any type.
- // Returns -9999 if no stations found within max_range in nautical miles (default 100 miles).
- // Note that the search algorithm starts at 10 miles and multiplies by 10 thereafter, so if
- // say 300 miles is specifed 10, then 100, then 1000 will be searched, breaking at first result
- // and giving up after 1000.
- // !!!Be warned that searching anything over 100 miles will pause the sim unacceptably!!!
- // (The ability to search longer ranges should be used during init only).
- double FindClosest( double lon, double lat, double elev, ATCData& ad, atc_type tp = INVALID, double max_range = 100.0 );
-
- // Find by Airport code.
- bool FindByCode( const string& ICAO, ATCData& ad, atc_type tp = INVALID );
-
- // Return the callsign for an ATIS transmission given transmission time and airport id
- // This maybe should get moved somewhere else!!
- int GetCallSign( const string& apt_id, int hours, int mins );
-
-private:
-
- // Comm stations mapped by frequency
- comm_map_type commlist_freq;
-
- // Comm stations mapped by bucket
- comm_map_type commlist_bck;
-
- // Load comms from a specified path (which must include the filename)
- bool LoadComms(const SGPath& path);
-
-//----------- This stuff is left over from atislist.[ch]xx and maybe should move somewhere else
- // Add structure and map for storing a log of atis transmissions
- // made in this session of FlightGear. This allows the callsign
- // to be allocated correctly wrt time.
- typedef struct {
- int hours;
- int mins;
- int callsign;
- } atis_transmission_type;
-
- typedef map < string, atis_transmission_type > atis_log_type;
- typedef atis_log_type::iterator atis_log_iterator;
- typedef atis_log_type::const_iterator atis_log_const_iterator;
-
- atis_log_type atislog;
-//-----------------------------------------------------------------------------------------------
-
-};
-
-
-extern FGCommList *current_commlist;
-
-
-#endif // _FG_COMMLIST_HXX
+++ /dev/null
-// FGGround - a class to provide ground control at larger airports.
-//
-// Written 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 <simgear/misc/sg_path.hxx>
-#include <simgear/math/sg_random.h>
-#include <simgear/debug/logstream.hxx>
-#include <simgear/misc/sgstream.hxx>
-#include <simgear/constants.h>
-#include <Main/globals.hxx>
-
-#include <stdlib.h>
-#include STL_FSTREAM
-
-#include "ground.hxx"
-#include "ATCutils.hxx"
-#include "AILocalTraffic.hxx"
-#include "ATCmgr.hxx"
-
-SG_USING_STD(ifstream);
-SG_USING_STD(cout);
-
-node::node() {
-}
-
-node::~node() {
- for(unsigned int i=0; i < arcs.size(); ++i) {
- delete arcs[i];
- }
-}
-
-// Make sure that a_path.cost += distance is safe from the moment it's created.
-a_path::a_path() {
- cost = 0;
-}
-
-FGGround::FGGround() {
- ATCmgr = globals->get_ATC_mgr();
- _type = GROUND;
- networkLoadOK = false;
- ground_traffic.erase(ground_traffic.begin(), ground_traffic.end());
- ground_traffic_itr = ground_traffic.begin();
-
- // Init the property nodes - TODO - need to make sure we're getting surface winds.
- wind_from_hdg = fgGetNode("/environment/wind-from-heading-deg", true);
- wind_speed_knots = fgGetNode("/environment/wind-speed-kt", true);
-
- // TODO - get the actual airport elevation
- aptElev = 0.0;
-}
-
-FGGround::FGGround(const string& id) {
- ATCmgr = globals->get_ATC_mgr();
- networkLoadOK = false;
- ground_traffic.erase(ground_traffic.begin(), ground_traffic.end());
- ground_traffic_itr = ground_traffic.begin();
- ident = id;
-
- // Init the property nodes - TODO - need to make sure we're getting surface winds.
- wind_from_hdg = fgGetNode("/environment/wind-from-heading-deg", true);
- wind_speed_knots = fgGetNode("/environment/wind-speed-kt", true);
-
- // TODO - get the actual airport elevation
- aptElev = 0.0;
-}
-
-FGGround::~FGGround() {
-}
-
-void FGGround::ParseRwyExits(node* np, char* es) {
- char* token;
- char estr[20];
- strcpy(estr, es);
- const char delimiters[] = "-";
- token = strtok(estr, delimiters);
- while(token != NULL) {
- int i = atoi(token);
- //cout << "token = " << token << endl;
- //cout << "rwy number = " << i << endl;
- //runways[(atoi(token))].exits.push_back(np);
- runways[i].exits.push_back(np);
- //cout << "token = " << token << '\n';
- token = strtok(NULL, delimiters);
- }
-}
-
-
-// Load the ground logical network of the current instances airport
-// Return true if successfull.
-// TODO - currently the file is assumed to reside in the base/ATC directory.
-// This might change to something more thought out in the future.
-// NOTE - currently it is assumed that all nodes are loaded before any arcs.
-// It won't work ATM if this doesn't hold true.
-bool FGGround::LoadNetwork() {
- node* np;
- arc* ap;
- Gate* gp;
-
- int gateCount = 0; // This is used to allocate gateID's from zero upwards
- // This may well change in the future - probably to reading in the real-world
- // gate numbers from file.
-
- ifstream fin;
- SGPath path = globals->get_fg_root();
- //string taxiPath = "ATC/" + ident + ".taxi";
- string taxiPath = "ATC/KEMT.taxi"; // FIXME - HARDWIRED FOR TESTING
- path.append(taxiPath);
-
- SG_LOG(SG_ATC, SG_INFO, "Trying to read taxiway data for " << ident << "...");
- //cout << "Trying to read taxiway data for " << ident << "..." << endl;
- fin.open(path.c_str(), ios::in);
- if(!fin) {
- SG_LOG(SG_ATC, SG_ALERT, "Unable to open taxiway data input file " << path.c_str());
- //cout << "Unable to open taxiway data input file " << path.c_str() << endl;
- return(false);
- }
-
- char ch;
- char buf[30];
- while(!fin.eof()) {
- fin >> buf;
- // Node, arc, or [End]?
- //cout << "Read in ground network element type = " << buf << endl;
- if(!strcmp(buf, "[End]")) { // TODO - maybe make this more robust to spelling errors by just looking for '['
- SG_LOG(SG_ATC, SG_INFO, "Done reading " << path.c_str() << endl);
- break;
- } else if(!strcmp(buf, "N")) {
- // Node
- np = new node;
- np->struct_type = NODE;
- fin >> buf;
- np->nodeID = atoi(buf);
- fin >> buf;
- np->pos.setlon(atof(buf));
- fin >> buf;
- np->pos.setlat(atof(buf));
- fin >> buf;
- np->pos.setelev(atof(buf));
- fin >> buf; // node type
- if(!strcmp(buf, "J")) {
- np->type = JUNCTION;
- } else if(!strcmp(buf, "T")) {
- np->type = TJUNCTION;
- } else if(!strcmp(buf, "H")) {
- np->type = HOLD;
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "**** ERROR ***** Unknown node type in taxi network...\n");
- delete np;
- return(false);
- }
- fin >> buf; // rwy exit information - gets parsed later - FRAGILE - will break if buf is reused.
- // Now the name
- fin >> ch; // strip the leading " off
- np->name = "";
- while(1) {
- fin.unsetf(ios::skipws);
- fin >> ch;
- if((ch == '"') || (ch == 0x0A)) {
- break;
- } // we shouldn't need the 0x0A but it makes a nice safely in case someone leaves off the "
- np->name += ch;
- }
- fin.setf(ios::skipws);
- network.push_back(np);
- // FIXME - fragile - replies on buf not getting modified from exits read to here
- // see if we also need to push it onto the runway exit list
- //cout << "strlen(buf) = " << strlen(buf) << endl;
- if(strlen(buf) > 2) {
- //cout << "Calling ParseRwyExits for " << buf << endl;
- ParseRwyExits(np, buf);
- }
- } else if(!strcmp(buf, "A")) {
- ap = new arc;
- ap->struct_type = ARC;
- fin >> buf;
- ap->n1 = atoi(buf);
- fin >> buf;
- ap->n2 = atoi(buf);
- fin >> buf;
- if(!strcmp(buf, "R")) {
- ap->type = RUNWAY;
- } else if(!strcmp(buf, "T")) {
- ap->type = TAXIWAY;
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "**** ERROR ***** Unknown arc type in taxi network...\n");
- delete ap;
- return(false);
- }
- // directed?
- fin >> buf;
- if(!strcmp(buf, "Y")) {
- ap->directed = true;
- } else if(!strcmp(buf, "N")) {
- ap->directed = false;
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "**** ERROR ***** Unknown arc directed value in taxi network - should be Y/N !!!\n");
- delete ap;
- return(false);
- }
- // Now the name
- ap->name = "";
- while(1) {
- fin.unsetf(ios::skipws);
- fin >> ch;
- ap->name += ch;
- if((ch == '"') || (ch == 0x0A)) {
- break;
- } // we shouldn't need the 0x0A but it makes a nice safely in case someone leaves off the "
- }
- fin.setf(ios::skipws);
- ap->distance = (int)dclGetHorizontalSeparation(network[ap->n1]->pos, network[ap->n2]->pos);
- //cout << "Distance = " << ap->distance << '\n';
- network[ap->n1]->arcs.push_back(ap);
- network[ap->n2]->arcs.push_back(ap);
- } else if(!strcmp(buf, "G")) {
- gp = new Gate;
- gp->struct_type = NODE;
- gp->type = GATE;
- fin >> buf;
- gp->nodeID = atoi(buf);
- fin >> buf;
- gp->pos.setlon(atof(buf));
- fin >> buf;
- gp->pos.setlat(atof(buf));
- fin >> buf;
- gp->pos.setelev(atof(buf));
- fin >> buf; // gate type - ignore this for now
- fin >> buf; // gate heading
- gp->heading = atoi(buf);
- // Now the name
- gp->name = "";
- while(1) {
- fin.unsetf(ios::skipws);
- fin >> ch;
- gp->name += ch;
- if((ch == '"') || (ch == 0x0A)) {
- break;
- } // we shouldn't need the 0x0A but it makes a nice safely in case someone leaves off the "
- }
- fin.setf(ios::skipws);
- gp->id = gateCount; // Warning - this will likely change in the future.
- gp->used = false;
- network.push_back(gp);
- gates[gateCount] = gp;
- gateCount++;
- } else {
- // Something has gone seriously pear-shaped
- SG_LOG(SG_ATC, SG_ALERT, "********* ERROR - unknown ground network element type... aborting read of " << path.c_str() << '\n');
- return(false);
- }
-
- fin >> skipeol;
- }
- return(true);
-}
-
-void FGGround::Init() {
- untowered = false;
-
- // Figure out which is the active runway - TODO - it would be better to have ground call tower
- // for runway operation details, but at the moment we can't guarantee that tower control at a given airport
- // will be initialised before ground so we can't do that.
- DoRwyDetails();
- //cout << "In FGGround::Init, active rwy is " << activeRwy << '\n';
- ortho.Init(rwy.threshold_pos, rwy.hdg);
-
- networkLoadOK = LoadNetwork();
-}
-
-void FGGround::Update(double dt) {
- // Each time step, what do we need to do?
- // We need to go through the list of outstanding requests and acknowedgements
- // and process at least one of them.
- // We need to go through the list of planes under our control and check if
- // any need to be addressed.
- // We need to check for planes not under our control coming within our
- // control area and address if necessary.
-
- // Lets take the example of a plane which has just contacted ground
- // following landing - presumably requesting where to go?
- // First we need to establish the position of the plane within the logical network.
- // Next we need to decide where its going.
-
- if(ground_traffic.size()) {
- if(ground_traffic_itr == ground_traffic.end()) {
- ground_traffic_itr = ground_traffic.begin();
- }
-
- //Process(*ground_traffic_itr);
- GroundRec* g = *ground_traffic_itr;
- if(g->taxiRequestOutstanding) {
- double responseTime = 10.0; // seconds - this should get more sophisticated at some point
- if(g->clearanceCounter > responseTime) {
- // DO CLEARANCE
- // TODO - move the mechanics of making up the transmission out of the main Update(...) routine.
- string trns = "";
- trns += g->plane.callsign;
- trns += " taxi holding point runway "; // TODO - add the holding point name
- // eg " taxi holding point G2 runway "
- trns += ConvertRwyNumToSpokenString(activeRwy);
- if(_display) {
- fgSetString("/sim/messages/ground", trns.c_str());
- }
- g->planePtr->RegisterTransmission(1); // cleared to taxi
- g->clearanceCounter = 0.0;
- g->taxiRequestOutstanding = false;
- } else {
- g->clearanceCounter += (dt * ground_traffic.size());
- }
- } else if(((FGAILocalTraffic*)(g->planePtr))->AtHoldShort()) { // That's a hack - eventually we should monitor actual position
- // HACK ALERT - the automatic cast to AILocalTraffic has to go once we have other sorts working!!!!! FIXME TODO
- // NOTE - we don't need to do the contact tower bit unless we have separate tower and ground
- string trns = g->plane.callsign;
- trns += " contact Tower ";
- double f = globals->get_ATC_mgr()->GetFrequency(ident, TOWER) / 100.0;
- char buf[10];
- sprintf(buf, "%.2f", f);
- trns += buf;
- if(_display) {
- fgSetString("/sim/messages/ground", trns.c_str());
- }
- g->planePtr->RegisterTransmission(2); // contact tower
- delete *ground_traffic_itr;
- ground_traffic.erase(ground_traffic_itr);
- ground_traffic_itr = ground_traffic.begin();
- }
- ++ground_traffic_itr;
- }
-
- // Call the base class update for the response time handling.
- FGATC::Update(dt);
-}
-
-// Figure out which runways are active.
-// For now we'll just be simple and do one active runway - eventually this will get much more complex
-// Copied from FGTower - TODO - it would be better to implement this just once, and have ground call tower
-// for runway operation details, but at the moment we can't guarantee that tower control at a given airport
-// will be initialised before ground so we can't do that.
-void FGGround::DoRwyDetails() {
- //cout << "GetRwyDetails called" << endl;
-
- // Based on the airport-id and wind get the active runway
-
- //wind
- double hdg = wind_from_hdg->getDoubleValue();
- double speed = wind_speed_knots->getDoubleValue();
- hdg = (speed == 0.0 ? 270.0 : hdg);
- //cout << "Heading = " << hdg << '\n';
-
- FGRunway runway;
- bool rwyGood = globals->get_runways()->search(ident, int(hdg), &runway);
- if(rwyGood) {
- activeRwy = runway._rwy_no;
- rwy.rwyID = runway._rwy_no;
- SG_LOG(SG_ATC, SG_INFO, "In FGGround, active runway for airport " << ident << " is " << activeRwy);
-
- // Get the threshold position
- double other_way = runway._heading - 180.0;
- while(other_way <= 0.0) {
- other_way += 360.0;
- }
- // move to the +l end/center of the runway
- //cout << "Runway center is at " << runway._lon << ", " << runway._lat << '\n';
- Point3D origin = Point3D(runway._lon, runway._lat, aptElev);
- Point3D ref = origin;
- double tshlon, tshlat, tshr;
- double tolon, tolat, tor;
- rwy.length = runway._length * SG_FEET_TO_METER;
- geo_direct_wgs_84 ( aptElev, ref.lat(), ref.lon(), other_way,
- rwy.length / 2.0 - 25.0, &tshlat, &tshlon, &tshr );
- geo_direct_wgs_84 ( aptElev, ref.lat(), ref.lon(), runway._heading,
- rwy.length / 2.0 - 25.0, &tolat, &tolon, &tor );
- // Note - 25 meters in from the runway end is a bit of a hack to put the plane ahead of the user.
- // now copy what we need out of runway into rwy
- rwy.threshold_pos = Point3D(tshlon, tshlat, aptElev);
- Point3D takeoff_end = Point3D(tolon, tolat, aptElev);
- //cout << "Threshold position = " << tshlon << ", " << tshlat << ", " << aptElev << '\n';
- //cout << "Takeoff position = " << tolon << ", " << tolat << ", " << aptElev << '\n';
- rwy.hdg = runway._heading;
- // Set the projection for the local area based on this active runway
- ortho.Init(rwy.threshold_pos, rwy.hdg);
- rwy.end1ortho = ortho.ConvertToLocal(rwy.threshold_pos); // should come out as zero
- rwy.end2ortho = ortho.ConvertToLocal(takeoff_end);
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "Help - can't get good runway in FGTower!!");
- activeRwy = "NN";
- }
-}
-
-// Return a random gate ID of an unused gate.
-// Two error values may be returned and must be checked for by the calling function:
-// -2 signifies that no gates exist at this airport.
-// -1 signifies that all gates are currently full.
-int FGGround::GetRandomGateID() {
- // Check that this airport actually has some gates!!
- if(!gates.size()) {
- return(-2);
- }
-
- gate_vec_type gateVec;
- int num = 0;
- int thenum;
- int ID;
-
- gatesItr = gates.begin();
- while(gatesItr != gates.end()) {
- if((gatesItr->second)->used == false) {
- gateVec.push_back(gatesItr->second);
- num++;
- }
- ++gatesItr;
- }
-
- // Check that there are some unused gates!
- if(!gateVec.size()) {
- return(-1);
- }
-
- // Randomly select one from the list
- sg_srandom_time();
- thenum = (int)(sg_random() * gateVec.size());
- ID = gateVec[thenum]->id;
-
- return(ID);
-}
-
-// Return a pointer to an unused gate node
-Gate* FGGround::GetGateNode() {
- int id = GetRandomGateID();
- if(id < 0) {
- return(NULL);
- } else {
- return(gates[id]);
- }
-}
-
-
-node* FGGround::GetHoldShortNode(const string& rwyID) {
- return(NULL); // TODO - either implement me or remove me!!!
-}
-
-
-// WARNING - This is hardwired to my prototype logical network format
-// and will almost certainly change when Bernie's stuff comes on-line.
-// Returns NULL if it can't find a valid node.
-node* FGGround::GetThresholdNode(const string& rwyID) {
- // For now go through all the nodes and parse their names
- // Maybe in the future we'll map threshold nodes by ID
- //cout << "Size of network is " << network.size() << '\n';
- for(unsigned int i=0; i<network.size(); ++i) {
- //cout << "Name = " << network[i]->name << '\n';
- if(network[i]->name.size()) {
- string s = network[i]->name;
- // Warning - the next bit is fragile and dependent on my current naming scheme
- //cout << "substr = " << s.substr(0,3) << '\n';
- //cout << "size of s = " << s.size() << '\n';
- if(s.substr(0,3) == "rwy") {
- //cout << "subsubstr = " << s.substr(4, s.size() - 4) << '\n';
- if(s.substr(4, s.size() - 4) == rwyID) {
- return network[i];
- }
- }
- }
- }
- return NULL;
-}
-
-
-// Get a path from a point on a runway to a gate
-// TODO !!
-
-// Get a path from a node to another node
-// Eventually we will need complex algorithms for this taking other traffic,
-// shortest path and suitable paths into accout.
-// For now we'll just call the shortest path algorithm.
-ground_network_path_type FGGround::GetPath(node* A, node* B) {
- return(GetShortestPath(A, B));
-};
-
-// Get a path from a node to a runway threshold
-ground_network_path_type FGGround::GetPath(node* A, const string& rwyID) {
- node* b = GetThresholdNode(rwyID);
- if(b == NULL) {
- SG_LOG(SG_ATC, SG_ALERT, "ERROR - unable to find path to runway theshold in ground.cxx for airport " << ident << '\n');
- ground_network_path_type emptyPath;
- emptyPath.erase(emptyPath.begin(), emptyPath.end());
- return(emptyPath);
- }
- return GetShortestPath(A, b);
-}
-
-// Get a path from a node to a runway hold short point
-// Bit of a hack this at the moment!
-ground_network_path_type FGGround::GetPathToHoldShort(node* A, const string& rwyID) {
- ground_network_path_type path = GetPath(A, rwyID);
- path.pop_back(); // That should be the threshold stripped of
- path.pop_back(); // and that should be the arc from hold short to threshold
- // This isn't robust though - TODO - implement properly!
- return(path);
-}
-
-// A shortest path algorithm from memory (ie. I can't find the bl&*dy book again!)
-// I'm sure there must be enchancements that we can make to this, such as biasing the
-// order in which the nodes are searched out from in favour of those geographically
-// closer to the destination.
-// Note that we are working with the master set of nodes and arcs so we mustn't change
-// or delete them - we only delete the paths that we create during the algorithm.
-ground_network_path_type FGGround::GetShortestPath(node* A, node* B) {
- a_path* pathPtr;
- shortest_path_map_type pathMap;
- node_array_type nodesLeft;
-
- // Debugging check
- int pathsCreated = 0;
-
- // Initialise the algorithm
- nodesLeft.push_back(A);
- pathPtr = new a_path;
- pathsCreated++;
- pathPtr->path.push_back(A);
- pathPtr->cost = 0;
- pathMap[A->nodeID] = pathPtr;
- bool solution_found = false; // Flag to indicate that at least one candidate path has been found
- int solution_cost = -1; // Cost of current best cost solution. -1 indicates no solution found yet.
- a_path solution_path;
-
- node* nPtr; // nPtr is used to point to the node we are currently working with
-
- while(nodesLeft.size()) {
- //cout << "\n*****nodesLeft*****\n";
- //for(unsigned int i=0; i<nodesLeft.size(); ++i) {
- //cout << nodesLeft[i]->nodeID << '\n';
- //}
- //cout << "*******************\n\n";
- nPtr = *nodesLeft.begin(); // Thought - definate optimization possibilities here in the choice of which nodes we process first.
- nodesLeft.erase(nodesLeft.begin());
- //cout << "Walking out from node " << nPtr->nodeID << '\n';
- for(unsigned int i=0; i<nPtr->arcs.size(); ++i) {
- //cout << "ARC TO " << ((nPtr->arcs[i]->n1 == nPtr->nodeID) ? nPtr->arcs[i]->n2 : nPtr->arcs[i]->n1) << '\n';
- }
- if((solution_found) && (solution_cost <= pathMap[nPtr->nodeID]->cost)) {
- // Do nothing - we've already found a solution and this partial path is already more expensive
- } else {
- // This path could still be better than the current solution - check it out
- for(unsigned int i=0; i<(nPtr->arcs.size()); i++) {
- // Map the new path against the end node, ie. *not* the one we just started with.
- unsigned int end_nodeID = ((nPtr->arcs[i]->n1 == nPtr->nodeID) ? nPtr->arcs[i]->n2 : nPtr->arcs[i]->n1);
- //cout << "end_nodeID = " << end_nodeID << '\n';
- //cout << "pathMap size is " << pathMap.size() << '\n';
- if(end_nodeID == nPtr->nodeID) {
- //cout << "Circular arc!\n";
- // Then its a circular arc - don't bother!!
- //nPtr->arcs.erase(nPtr->arcs.begin() + i);
- } else {
- // see if the end node is already in the map or not
- if(pathMap.find(end_nodeID) == pathMap.end()) {
- //cout << "Not in the map" << endl;;
- // Not in the map - easy!
- pathPtr = new a_path;
- pathsCreated++;
- *pathPtr = *pathMap[nPtr->nodeID]; // *copy* the path
- pathPtr->path.push_back(nPtr->arcs[i]);
- pathPtr->path.push_back(network[end_nodeID]);
- pathPtr->cost += nPtr->arcs[i]->distance;
- pathMap[end_nodeID] = pathPtr;
- nodesLeft.push_back(network[end_nodeID]); // By definition this can't be in the list already, or
- // it would also have been in the map and hence OR'd with this one.
- if(end_nodeID == B->nodeID) {
- //cout << "Solution found!!!" << endl;
- // Since this node wasn't in the map this is by definition the first solution
- solution_cost = pathPtr->cost;
- solution_path = *pathPtr;
- solution_found = true;
- }
- } else {
- //cout << "Already in the map" << endl;
- // In the map - not so easy - need to get rid of an arc from the higher cost one.
- //cout << "Current cost of node " << end_nodeID << " is " << pathMap[end_nodeID]->cost << endl;
- int newCost = pathMap[nPtr->nodeID]->cost + nPtr->arcs[i]->distance;
- //cout << "New cost is of node " << nPtr->nodeID << " is " << newCost << endl;
- if(newCost >= pathMap[end_nodeID]->cost) {
- // No need to do anything.
- //cout << "Not doing anything!" << endl;
- } else {
- delete pathMap[end_nodeID];
- pathsCreated--;
-
- pathPtr = new a_path;
- pathsCreated++;
- *pathPtr = *pathMap[nPtr->nodeID]; // *copy* the path
- pathPtr->path.push_back(nPtr->arcs[i]);
- pathPtr->path.push_back(network[end_nodeID]);
- pathPtr->cost += nPtr->arcs[i]->distance;
- pathMap[end_nodeID] = pathPtr;
-
- // We need to add this node to the list-to-do again to force a recalculation
- // onwards from this node with the new lower cost to node cost.
- nodesLeft.push_back(network[end_nodeID]);
-
- if(end_nodeID == B->nodeID) {
- //cout << "Solution found!!!" << endl;
- // Need to check if there is a previous better solution
- if((solution_cost < 0) || (pathPtr->cost < solution_cost)) {
- solution_cost = pathPtr->cost;
- solution_path = *pathPtr;
- solution_found = true;
- }
- }
- }
- }
- }
- }
- }
- }
-
- // delete all the paths before returning
- shortest_path_map_iterator spItr = pathMap.begin();
- while(spItr != pathMap.end()) {
- if(spItr->second != NULL) {
- delete spItr->second;
- --pathsCreated;
- }
- ++spItr;
- }
-
- //cout << "pathsCreated = " << pathsCreated << '\n';
- if(pathsCreated > 0) {
- SG_LOG(SG_ATC, SG_ALERT, "WARNING - Possible memory leak in FGGround::GetShortestPath\n\
- Please report to flightgear-devel@flightgear.org\n");
- }
-
- //cout << (solution_found ? "Result: solution found\n" : "Result: no solution found\n");
- return(solution_path.path); // TODO - we really ought to have a fallback position incase a solution isn't found.
-}
-
-
-
-// Randomly or otherwise populate some of the gates with parked planes
-// (might eventually be done by the AIMgr if and when lots of AI traffic is generated)
-
-// Return a list of exits from a given runway
-// It is up to the calling function to check for non-zero size of returned array before use
-node_array_type FGGround::GetExits(const string& rwyID) {
- // FIXME - get a 07L or similar in here and we're stuffed!!!
- return(runways[atoi(rwyID.c_str())].exits);
-}
-
-void FGGround::RequestDeparture(const PlaneRec& plane, FGAIEntity* requestee) {
- // For now we'll just automatically clear all planes to the runway hold.
- // This communication needs to be delayed 20 sec or so from receiving the request.
- // Even if display=false we still need to start the timer in case display=true when communication starts.
- // We also need to bear in mind we also might have other outstanding communications, although for now we'll punt that issue!
- // FIXME - sort the above!
-
- // HACK - assume that anything requesting departure is new for now - FIXME LATER
- GroundRec* g = new GroundRec;
- g->plane = plane;
- g->planePtr = requestee;
- g->taxiRequestOutstanding = true;
- g->clearanceCounter = 0;
- g->cleared = false;
- g->incoming = false;
- // TODO - need to handle the next 3 as well
- //Point3D current_pos;
- //node* destination;
- //node* last_clearance;
-
- ground_traffic.push_back(g);
-}
-
-#if 0
-void FGGround::NewArrival(plane_rec plane) {
- // What are we going to do here?
- // We need to start a new ground_rec and add the plane_rec to it
- // We need to decide what gate we are going to clear it to.
- // Then we need to add clearing it to that gate to the pending transmissions queue? - or simply transmit?
- // Probably simply transmit for now and think about a transmission queue later if we need one.
- // We might need one though in order to add a little delay for response time.
- ground_rec* g = new ground_rec;
- g->plane_rec = plane;
- g->current_pos = ConvertWGS84ToXY(plane.pos);
- g->node = GetNode(g->current_pos); // TODO - might need to sort out node/arc here
- AssignGate(g);
- g->cleared = false;
- ground_traffic.push_back(g);
- NextClearance(g);
-}
-
-void FGGround::NewContact(plane_rec plane) {
- // This is a bit of a convienience function at the moment and is likely to change.
- if(at a gate or apron)
- NewDeparture(plane);
- else
- NewArrival(plane);
-}
-
-void FGGround::NextClearance(ground_rec &g) {
- // Need to work out where we can clear g to.
- // Assume the pilot doesn't need progressive instructions
- // We *should* already have a gate or holding point assigned by the time we get here
- // but it wouldn't do any harm to check.
-
- // For now though we will hardwire it to clear to the final destination.
-}
-
-void FGGround::AssignGate(ground_rec &g) {
- // We'll cheat for now - since we only have the user's aircraft and a couple of airports implemented
- // we'll hardwire the gate!
- // In the long run the logic of which gate or area to send the plane to could be somewhat non-trivial.
-}
-#endif //0
-
+++ /dev/null
-// FGGround - a class to provide ground control at larger airports.
-//
-// Written 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.
-
-#ifndef _FG_GROUND_HXX
-#define _FG_GROUND_HXX
-
-#include <map>
-#include <vector>
-#include <list>
-
-#include <simgear/math/point3d.hxx>
-#include <simgear/misc/sgstream.hxx>
-#include <simgear/math/sg_geodesy.hxx>
-#include <simgear/props/props.hxx>
-
-#include "ATC.hxx"
-#include "ATCProjection.hxx"
-
-#include STL_IOSTREAM
-#include STL_STRING
-
-SG_USING_STD(string);
-SG_USING_STD(ios);
-
-SG_USING_STD(map);
-SG_USING_STD(vector);
-SG_USING_STD(list);
-
-class FGAIEntity;
-class FGATCMgr;
-
-//////////////////////////////////////////////////////
-// Types for the logical network data structure
-enum arc_type {
- RUNWAY,
- TAXIWAY
-};
-
-enum node_type {
- GATE,
- APRON,
- HOLD,
- JUNCTION,
- TJUNCTION
-};
-
-enum GateType {
- TRANSPORT_PASSENGER,
- TRANSPORT_PASSENGER_NARROWBODY,
- TRANSPORT_PASSENGER_WIDEBODY,
- TRANSPORT_CARGO,
- GA_LOCAL,
- GA_LOCAL_SINGLE,
- GA_LOCAL_TWIN,
- GA_TRANSIENT,
- GA_TRANSIENT_SINGLE,
- GA_TRANSIENT_TWIN,
- OTHER // ie. anything goes!!
-};
-
-enum network_element_type {
- NODE,
- ARC
-};
-
-struct ground_network_element {
- network_element_type struct_type;
-};
-
-struct arc : public ground_network_element {
- int distance;
- string name;
- arc_type type;
- bool directed; //false if 2-way, true if 1-way.
- //This is a can of worms since arcs might be one way in different directions under different circumstances
- unsigned int n1; // The nodeID of the first node
- unsigned int n2; // The nodeID of the second node
- // If the arc is directed then flow is normally from n1 to n2. See the above can of worms comment though.
-};
-
-typedef vector <arc*> arc_array_type; // This was and may become again a list instead of vector
-typedef arc_array_type::iterator arc_array_iterator;
-typedef arc_array_type::const_iterator arc_array_const_iterator;
-
-struct node : public ground_network_element {
- node();
- ~node();
-
- unsigned int nodeID; //each node in an airport needs a unique ID number - this is ZERO-BASED to match array position
- Point3D pos;
- Point3D orthoPos;
- string name;
- node_type type;
- arc_array_type arcs;
- double max_turn_radius;
-};
-
-typedef vector <node*> node_array_type;
-typedef node_array_type::iterator node_array_iterator;
-typedef node_array_type::const_iterator node_array_const_iterator;
-
-struct Gate : public node {
- GateType gateType;
- int max_weight; //units??
- //airline_code airline; //For the future - we don't have any airline codes ATM
- int id; // The gate number in the logical scheme of things
- string name; // The real-world gate letter/number
- //node* pNode;
- bool used;
- double heading; // The direction the parked-up plane should point in degrees
-};
-
-typedef vector < Gate* > gate_vec_type;
-typedef gate_vec_type::iterator gate_vec_iterator;
-typedef gate_vec_type::const_iterator gate_vec_const_iterator;
-
-// A map of gate vs. the logical (internal FGFS) gate ID
-typedef map < int, Gate* > gate_map_type;
-typedef gate_map_type::iterator gate_map_iterator;
-typedef gate_map_type::const_iterator gate_map_const_iterator;
-
-// Runways - all the runway stuff is likely to change in the future
-struct Rwy {
- int id; //note this is a very simplified scheme for now - R & L are not differentiated
- //It should work for simple one rwy airports
- node_array_type exits; //Array of available exits from runway
- // should probably add an FGRunway structure here as well eventually
- // Eventually we will also want some encoding of real-life preferred runways
- // This will get us up and running for single runway airports though.
-};
-
-typedef vector < Rwy > runway_array_type;
-typedef runway_array_type::iterator runway_array_iterator;
-typedef runway_array_type::const_iterator runway_array_const_iterator;
-
-// end logical network types
-///////////////////////////////////////////////////////
-
-///////////////////////////////////////////////////////
-// Structures to use the network
-
-// A path through the network
-typedef vector < ground_network_element* > ground_network_path_type;
-typedef ground_network_path_type::iterator ground_network_path_iterator;
-typedef ground_network_path_type::const_iterator ground_network_path_const_iterator;
-
-//////////////////////////////////////////////////////////////////////////////////////////
-
-////////////////////////////////////////////////
-//
-// Stuff for the shortest-path algorithms
-struct a_path {
- a_path();
-
- ground_network_path_type path;
- int cost;
-};
-
-// Paths mapped by nodeID reached so-far
-typedef map < unsigned int, a_path* > shortest_path_map_type;
-typedef shortest_path_map_type::iterator shortest_path_map_iterator;
-
-// Nodes mapped by their ID
-//typedef map < unsigned int, node* > node_map_type;
-//typedef node_map_type::iterator node_map_iterator;
-////////////////////////////////////////////////
-
-// Planes active within the ground network.
-
-// A more specialist plane rec to include ground information
-struct GroundRec {
- FGAIEntity* planePtr; // This might move to the planeRec eventually
-
- PlaneRec plane;
- Point3D current_pos;
- node* destination;
- node* last_clearance;
- bool taxiRequestOutstanding; // Plane has requested taxi and we haven't responded yet
- double clearanceCounter; // Hack for communication timing - counter since clearance requested in seconds
-
- bool cleared; // set true when the plane has been cleared to somewhere
- bool incoming; //true for arrivals, false for departures
- // status?
- // Almost certainly need to add more here
-};
-
-typedef list < GroundRec* > ground_rec_list;
-typedef ground_rec_list::iterator ground_rec_list_itr;
-typedef ground_rec_list::const_iterator ground_rec_list_const_itr;
-
-//////////////////////////////////////////////////////////////////////////////////////////
-
-// Hack
-// perhaps we could use an FGRunway instead of this
-struct GRunwayDetails {
- Point3D threshold_pos;
- Point3D end1ortho; // ortho projection end1 (the threshold ATM)
- Point3D end2ortho; // ortho projection end2 (the take off end in the current hardwired scheme)
- double hdg; // true runway heading
- double length; // In *METERS*
- string rwyID;
-};
-
-///////////////////////////////////////////////////////////////////////////////
-//
-// FGGround
-//
-///////////////////////////////////////////////////////////////////////////////
-class FGGround : public FGATC {
-
-public:
- FGGround();
- FGGround(const string& id);
- ~FGGround();
- void Init();
-
- void Update(double dt);
-
- inline const string& get_trans_ident() { return trans_ident; }
-
- // Contact ground control on arrival, assumed to request any gate
- //void NewArrival(plane_rec plane);
-
- // Contact ground control on departure, assumed to request currently active runway.
- void RequestDeparture(const PlaneRec& plane, FGAIEntity* requestee);
-
- // Contact ground control when the calling routine doesn't know if arrival
- // or departure is appropriate.
- //void NewContact(plane_rec plane);
-
- // Make a request of ground control.
- //void Request(ground_request request);
-
- // Randomly fill some of the available gates and GA parking spots with planes
- void PopulateGates();
-
- // Return a suitable gate (maybe this should be a list of suitable gates so the plane or controller can choose the closest one)
- void ReturnGate(Gate &gate, GateType type);
-
- // Return a pointer to an unused gate
- Gate* GetGateNode();
-
- // Return a pointer to a hold short node
- node* GetHoldShortNode(const string& rwyID);
-
- // Runway stuff - this might change in the future.
- // Get a list of exits from a given runway
- // It is up to the calling function to check for non-zero size of returned array before use
- node_array_type GetExits(const string& rwyID);
-
- // Get a path from one node to another
- ground_network_path_type GetPath(node* A, node* B);
-
- // Get a path from a node to a runway threshold
- ground_network_path_type GetPath(node* A, const string& rwyID);
-
- // Get a path from a node to a runway hold short point
- // Bit of a hack this at the moment!
- ground_network_path_type GetPathToHoldShort(node* A, const string& rwyID);
-
-private:
- FGATCMgr* ATCmgr;
- // This is purely for synactic convienience to avoid writing globals->get_ATC_mgr()-> all through the code!
-
- // Need a data structure to hold details of the various active planes
- // Need a data structure to hold details of the logical network
- // including which gates are filled - or possibly another data structure
- // with the positions of the inactive planes.
- // Need a data structure to hold outstanding communications from aircraft.
- // Possibly need a data structure to hold outstanding communications to aircraft.
-
- // The logical network
- // NODES WILL BE STORED IN THE NETWORK IN ORDER OF nodeID NUMBER
- // ie. NODE 5 WILL BE AT network[5]
- node_array_type network;
-
- // A map of all the gates indexed against internal (FGFS) ID
- gate_map_type gates;
- gate_map_iterator gatesItr;
-
- FGATCAlignedProjection ortho;
-
- // Planes currently active
- //ground_rec_list ground_traffic;
-
- // Find the shortest route through the logical network between two points.
- //FindShortestRoute(point a, point b);
-
- // Assign a gate or parking location to a new arrival
- //AssignGate(ground_rec &g);
-
- // Generate the next clearance for an airplane
- //NextClearance(ground_rec &g);
-
- // environment - need to make sure we're getting the surface winds and not winds aloft.
- SGPropertyNode_ptr wind_from_hdg; //degrees
- SGPropertyNode_ptr wind_speed_knots; //knots
-
- // for failure modeling
- string trans_ident; // transmitted ident
- bool ground_failed; // ground failed?
- bool networkLoadOK; // Indicates whether LoadNetwork returned true or false at last attempt
-
- // Tower control
- bool untowered; // True if this is an untowered airport (we still need the ground class for shortest path implementation etc
- //FGATC* tower; // Pointer to the tower control
-
- // Logical runway details - this might change in the future.
- //runway_array_type runways; // STL way
- Rwy runways[37]; // quick hack!
-
- // Physical runway details
- double aptElev; // Airport elevation
- string activeRwy; // Active runway number - For now we'll disregard multiple / alternate runway operation.
- RunwayDetails rwy; // Assumed to be the active one for now.// Figure out which runways are active.
-
- // For now we'll just be simple and do one active runway - eventually this will get much more complex
- // Copied from FGTower - TODO - it would be better to implement this just once, and have ground call tower
- // for runway operation details, but at the moment we can't guarantee that tower control at a given airport
- // will be initialised before ground so we can't do that.
- void DoRwyDetails();
-
- // Load the logical ground network for this airport from file.
- // Return true if successfull.
- bool LoadNetwork();
-
- // Parse a runway exit string and push the supplied node pointer onto the runway exit list
- void ParseRwyExits(node* np, char* es);
-
- // Return a random gate ID of an unused gate.
- // Two error values may be returned and must be checked for by the calling function:
- // -2 signifies that no gates exist at this airport.
- // -1 signifies that all gates are currently full.
- // TODO - modify to return a suitable gate based on aircraft size/weight.
- int GetRandomGateID();
-
- // Return a pointer to the node at a runway threshold
- // Returns NULL if unsuccessful.
- node* GetThresholdNode(const string& rwyID);
-
- // A shortest path algorithm from memory (I can't find the bl&*dy book again!)
- ground_network_path_type GetShortestPath(node* A, node* B);
-
- // Planes
- ground_rec_list ground_traffic;
- ground_rec_list_itr ground_traffic_itr;
-};
-
-#endif // _FG_GROUND_HXX
-
+++ /dev/null
-// FGTower - a class to provide tower control at towered airports.
-//
-// Written by David Luff, started March 2002.
-//
-// Copyright (C) 2002 David C. Luff - david.luff@nottingham.ac.uk
-// Copyright (C) 2008 Daniyar Atadjanov (ground clearance, gear check, weather, etc.)
-//
-// 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
-
-#ifdef HAVE_STRINGS_H
-# include <strings.h> // bcopy()
-#else
-# include <string.h> // MSVC doesn't have strings.h
-#endif
-
-#include <sstream>
-#include <iomanip>
-
-#include <simgear/debug/logstream.hxx>
-#include <simgear/math/sg_geodesy.hxx>
-#include <simgear/math/sg_random.h>
-#include <simgear/misc/sg_path.hxx>
-
-#include <Main/globals.hxx>
-#include <Airports/runways.hxx>
-
-#include "tower.hxx"
-#include "ATCmgr.hxx"
-#include "ATCutils.hxx"
-#include "ATCDialog.hxx"
-#include "commlist.hxx"
-#include "AILocalTraffic.hxx"
-
-
-SG_USING_STD(cout);
-
-// TowerPlaneRec
-
-TowerPlaneRec::TowerPlaneRec() :
- planePtr(NULL),
- clearedToLand(false),
- clearedToLineUp(false),
- clearedToTakeOff(false),
- holdShortReported(false),
- lineUpReported(false),
- downwindReported(false),
- longFinalReported(false),
- longFinalAcknowledged(false),
- finalReported(false),
- finalAcknowledged(false),
- rwyVacatedReported(false),
- rwyVacatedAcknowledged(false),
- goAroundReported(false),
- instructedToGoAround(false),
- onRwy(false),
- nextOnRwy(false),
- vfrArrivalReported(false),
- vfrArrivalAcknowledged(false),
- opType(TTT_UNKNOWN),
- leg(LEG_UNKNOWN),
- landingType(AIP_LT_UNKNOWN),
- gearWasUp(false),
- gearUpReported(false),
- isUser(false)
-{
- plane.callsign = "UNKNOWN";
-}
-
-TowerPlaneRec::TowerPlaneRec(const PlaneRec& p) :
- planePtr(NULL),
- clearedToLand(false),
- clearedToLineUp(false),
- clearedToTakeOff(false),
- holdShortReported(false),
- lineUpReported(false),
- downwindReported(false),
- longFinalReported(false),
- longFinalAcknowledged(false),
- finalReported(false),
- finalAcknowledged(false),
- rwyVacatedReported(false),
- rwyVacatedAcknowledged(false),
- goAroundReported(false),
- instructedToGoAround(false),
- onRwy(false),
- nextOnRwy(false),
- vfrArrivalReported(false),
- vfrArrivalAcknowledged(false),
- opType(TTT_UNKNOWN),
- leg(LEG_UNKNOWN),
- landingType(AIP_LT_UNKNOWN),
- gearWasUp(false),
- gearUpReported(false),
- isUser(false)
-{
- plane = p;
-}
-
-TowerPlaneRec::TowerPlaneRec(const Point3D& pt) :
- planePtr(NULL),
- clearedToLand(false),
- clearedToLineUp(false),
- clearedToTakeOff(false),
- holdShortReported(false),
- lineUpReported(false),
- downwindReported(false),
- longFinalReported(false),
- longFinalAcknowledged(false),
- finalReported(false),
- finalAcknowledged(false),
- rwyVacatedReported(false),
- rwyVacatedAcknowledged(false),
- goAroundReported(false),
- instructedToGoAround(false),
- onRwy(false),
- nextOnRwy(false),
- vfrArrivalReported(false),
- vfrArrivalAcknowledged(false),
- opType(TTT_UNKNOWN),
- leg(LEG_UNKNOWN),
- landingType(AIP_LT_UNKNOWN),
- gearWasUp(false),
- gearUpReported(false),
- isUser(false)
-{
- plane.callsign = "UNKNOWN";
- pos = pt;
-}
-
-TowerPlaneRec::TowerPlaneRec(const PlaneRec& p, const Point3D& pt) :
- planePtr(NULL),
- clearedToLand(false),
- clearedToLineUp(false),
- clearedToTakeOff(false),
- holdShortReported(false),
- lineUpReported(false),
- downwindReported(false),
- longFinalReported(false),
- longFinalAcknowledged(false),
- finalReported(false),
- finalAcknowledged(false),
- rwyVacatedReported(false),
- rwyVacatedAcknowledged(false),
- goAroundReported(false),
- instructedToGoAround(false),
- onRwy(false),
- nextOnRwy(false),
- vfrArrivalReported(false),
- vfrArrivalAcknowledged(false),
- opType(TTT_UNKNOWN),
- leg(LEG_UNKNOWN),
- landingType(AIP_LT_UNKNOWN),
- gearWasUp(false),
- gearUpReported(false),
- isUser(false)
-{
- plane = p;
- pos = pt;
-}
-
-
-// FGTower
-
-/*******************************************
- TODO List
-
-Currently user is assumed to have taken off again when leaving the runway - check speed/elev for taxiing-in. (MAJOR)
-
-Use track instead of heading to determine what leg of the circuit the user is flying. (MINOR)
-
-Use altitude as well as position to try to determine if the user has left the circuit. (MEDIUM - other issues as well).
-
-Currently HoldShortReported code assumes there will be only one plane holding for the runway at once and
-will break when planes start queueing. (CRITICAL)
-
-Report-Runway-Vacated is left as only user ATC option following a go-around. (MAJOR)
-
-Report-Downwind is not added as ATC option when user takes off to fly a circuit. (MAJOR)
-
-eta of USER can be calculated very wrongly in circuit if flying straight out and turn4 etc are with +ve ortho y.
-This can then screw up circuit ordering for other planes (MEDIUM)
-
-USER leaving circuit needs to be more robustly considered when intentions unknown
-Currently only considered during climbout and breaks when user turns (MEDIUM).
-
-GetPos() of the AI planes is called erratically - either too much or not enough. (MINOR)
-
-GO-AROUND is instructed very late at < 12s to landing - possibly make more dependent on chance of rwy clearing before landing (FEATURE)
-
-Need to make clear when TowerPlaneRecs do or don't get deleted in RemoveFromCircuitList etc. (MINOR until I misuse it - then CRITICAL!)
-
-FGTower::RemoveAllUserDialogOptions() really ought to be replaced by an ATCDialog::clear_entries() function. (MINOR - efficiency).
-
-At the moment planes in the lists are not guaranteed to always have a sensible ETA - it should be set as part of AddList functions, and lists should only be accessed this way. (FAIRLY MAJOR).
-*******************************************/
-
-FGTower::FGTower() :
- separateGround(true),
- ground(0)
-{
- ATCmgr = globals->get_ATC_mgr();
-
- _type = TOWER;
-
- // Init the property nodes - TODO - need to make sure we're getting surface winds.
- wind_from_hdg = fgGetNode("/environment/wind-from-heading-deg", true);
- wind_speed_knots = fgGetNode("/environment/wind-speed-kt", true);
-
- update_count = 0;
- update_count_max = 15;
-
- holdListItr = holdList.begin();
- appListItr = appList.begin();
- depListItr = depList.begin();
- rwyListItr = rwyList.begin();
- circuitListItr = circuitList.begin();
- trafficListItr = trafficList.begin();
- vacatedListItr = vacatedList.begin();
-
- freqClear = true;
-
- timeSinceLastDeparture = 9999;
- departed = false;
-
- nominal_downwind_leg_pos = 1000.0;
- nominal_base_leg_pos = -1000.0;
- // TODO - set nominal crosswind leg pos based on minimum distance from takeoff end of rwy.
-
- _departureControlled = false;
-}
-
-FGTower::~FGTower() {
- if(!separateGround) {
- delete ground;
- }
-}
-
-void FGTower::Init() {
- //cout << "Initialising tower " << ident << '\n';
-
- // Pointers to user's position
- user_lon_node = fgGetNode("/position/longitude-deg", true);
- user_lat_node = fgGetNode("/position/latitude-deg", true);
- user_elev_node = fgGetNode("/position/altitude-ft", true);
- user_hdg_node = fgGetNode("/orientation/heading-deg", true);
-
- // Need some way to initialise rwyOccupied flag correctly if the user is on the runway and to know its the user.
- // I'll punt the startup issue for now though!!!
- rwyOccupied = false;
-
- // Setup the ground control at this airport
- AirportATC a;
- //cout << "Tower ident = " << ident << '\n';
- if(ATCmgr->GetAirportATCDetails(ident, &a)) {
- if(a.ground_freq) { // Ground control
- ground = (FGGround*)ATCmgr->GetATCPointer(ident, GROUND);
- separateGround = true;
- if(ground == NULL) {
- // Something has gone wrong :-(
- SG_LOG(SG_ATC, SG_WARN, "ERROR - ground has frequency but can't get ground pointer :-(");
- ground = new FGGround(ident);
- separateGround = false;
- ground->Init();
- if(_display) {
- ground->SetDisplay();
- } else {
- ground->SetNoDisplay();
- }
- }
- } else {
- // Initialise ground anyway to do the shortest path stuff!
- // Note that we're now responsible for updating and deleting this - NOT the ATCMgr.
- ground = new FGGround(ident);
- separateGround = false;
- ground->Init();
- if(_display) {
- ground->SetDisplay();
- } else {
- ground->SetNoDisplay();
- }
- }
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "Unable to find airport details for " << ident << " in FGTower::Init()");
- // Initialise ground anyway to avoid segfault later
- ground = new FGGround(ident);
- separateGround = false;
- ground->Init();
- if(_display) {
- ground->SetDisplay();
- } else {
- ground->SetNoDisplay();
- }
- }
-
- RemoveAllUserDialogOptions();
-
- // TODO - attempt to get a departure control pointer to see if we need to hand off departing traffic to departure.
-
- // Get the airport elevation
- aptElev = fgGetAirportElev(ident.c_str());
-
- // TODO - this function only assumes one active rwy.
- DoRwyDetails();
-
- // TODO - this currently assumes only one active runway.
- rwyOccupied = OnActiveRunway(Point3D(user_lon_node->getDoubleValue(), user_lat_node->getDoubleValue(), 0.0));
-
- if(!OnAnyRunway(Point3D(user_lon_node->getDoubleValue(), user_lat_node->getDoubleValue(), 0.0), false)) {
- //cout << ident << " ADD 0\n";
- current_atcdialog->add_entry(ident, "@AP Tower, @CS @MI miles @CD of the airport for full stop@AT",
- "Contact tower for VFR arrival (full stop)", TOWER,
- (int)USER_REQUEST_VFR_ARRIVAL_FULL_STOP);
- } else {
- //cout << "User found on active runway\n";
- // Assume the user is started at the threshold ready to take-off
- TowerPlaneRec* t = new TowerPlaneRec;
- t->plane.callsign = fgGetString("/sim/user/callsign");
- t->plane.type = GA_SINGLE; // FIXME - hardwired!!
- t->opType = TTT_UNKNOWN; // We don't know if the user wants to do circuits or a departure...
- t->landingType = AIP_LT_UNKNOWN;
- t->leg = TAKEOFF_ROLL;
- t->isUser = true;
- t->planePtr = NULL;
- t->clearedToTakeOff = false;
- rwyList.push_back(t);
- rwyListItr = rwyList.begin();
- departed = false;
- current_atcdialog->add_entry(ident, "@CS @TO", "Request departure / take-off clearance",
- TOWER, (int)USER_REQUEST_TAKE_OFF);
- }
-}
-
-void FGTower::Update(double dt) {
- //cout << "T" << endl;
- // Each time step, what do we need to do?
- // We need to go through the list of outstanding requests and acknowedgements
- // and process at least one of them.
- // We need to go through the list of planes under our control and check if
- // any need to be addressed.
- // We need to check for planes not under our control coming within our
- // control area and address if necessary.
-
- // TODO - a lot of the below probably doesn't need to be called every frame and should be staggered.
-
- // Sort the arriving planes
-
- /*
- if(ident == "KEMT") {
- cout << update_count << "\ttL: " << trafficList.size() << " cL: " << circuitList.size() << " hL: " << holdList.size() << " aL: " << appList.size() << '\n';
- }
- */
- //if(ident == "EGNX") cout << display << '\n';
-
- if(departed != false) {
- timeSinceLastDeparture += dt;
- //if(ident == "KEMT")
- // cout << " dt = " << dt << " timeSinceLastDeparture = " << timeSinceLastDeparture << '\n';
- }
-
- //cout << ident << " respond = " << respond << " responseReqd = " << responseReqd << '\n';
- if(respond) {
- if(!responseReqd) SG_LOG(SG_ATC, SG_ALERT, "ERROR - respond is true and responseReqd is false in FGTower::Update(...)");
- Respond();
- respond = false;
- responseReqd = false;
- }
-
- // Calculate the eta of each plane to the threshold.
- // For ground traffic this is the fastest they can get there.
- // For air traffic this is the middle approximation.
- if(update_count == 1) {
- doThresholdETACalc();
- }
-
- // Order the list of traffic as per expected threshold use and flag any conflicts
- if(update_count == 2) {
- //bool conflicts = doThresholdUseOrder();
- doThresholdUseOrder();
- }
-
- // sortConficts() !!!
-
- if(update_count == 4) {
- CheckHoldList(dt);
- }
-
- // Uggh - HACK - why have we got rwyOccupied - wouldn't simply testing rwyList.size() do?
- if(rwyList.size()) {
- rwyOccupied = true;
- } else {
- rwyOccupied = false;
- }
-
- if(update_count == 5 && rwyOccupied) {
- CheckRunwayList(dt);
- }
-
- if(update_count == 6) {
- CheckCircuitList(dt);
- }
-
- if(update_count == 7) {
- CheckApproachList(dt);
- }
-
- if(update_count == 8) {
- CheckDepartureList(dt);
- }
-
- // TODO - do one plane from the departure list and set departed = false when out of consideration
-
- //doCommunication();
-
- if(!separateGround) {
- // The display stuff might have to get more clever than this when not separate
- // since the tower and ground might try communicating simultaneously even though
- // they're mean't to be the same contoller/frequency!!
- // We could also get rid of this by overloading FGATC's Set(No)Display() functions.
- if(_display) {
- ground->SetDisplay();
- } else {
- ground->SetNoDisplay();
- }
- ground->Update(dt);
- }
-
- ++update_count;
- // How big should ii get - ie how long should the update cycle interval stretch?
- if(update_count >= update_count_max) {
- update_count = 0;
- }
-
- // Call the base class update for the response time handling.
- FGATC::Update(dt);
-
- /*
- if(ident == "KEMT") {
- // For AI debugging convienience - may be removed
- Point3D user_pos;
- user_pos.setlon(user_lon_node->getDoubleValue());
- user_pos.setlat(user_lat_node->getDoubleValue());
- user_pos.setelev(user_elev_node->getDoubleValue());
- Point3D user_ortho_pos = ortho.ConvertToLocal(user_pos);
- fgSetDouble("/AI/user/ortho-x", user_ortho_pos.x());
- fgSetDouble("/AI/user/ortho-y", user_ortho_pos.y());
- fgSetDouble("/AI/user/elev", user_elev_node->getDoubleValue());
- }
- */
-
- //cout << "Done T" << endl;
-}
-
-void FGTower::ReceiveUserCallback(int code) {
- if(code == (int)USER_REQUEST_VFR_DEPARTURE) {
- RequestDepartureClearance("USER");
- } else if(code == (int)USER_REQUEST_VFR_ARRIVAL) {
- VFRArrivalContact("USER");
- } else if(code == (int)USER_REQUEST_VFR_ARRIVAL_FULL_STOP) {
- VFRArrivalContact("USER", FULL_STOP);
- } else if(code == (int)USER_REQUEST_VFR_ARRIVAL_TOUCH_AND_GO) {
- VFRArrivalContact("USER", TOUCH_AND_GO);
- } else if(code == (int)USER_REPORT_DOWNWIND) {
- ReportDownwind("USER");
- } else if(code == (int)USER_REPORT_3_MILE_FINAL) {
- // For now we'll just call report final instead of report long final to avoid having to alter the response code
- ReportFinal("USER");
- } else if(code == (int)USER_REPORT_RWY_VACATED) {
- ReportRunwayVacated("USER");
- } else if(code == (int)USER_REPORT_GOING_AROUND) {
- ReportGoingAround("USER");
- } else if(code == (int)USER_REQUEST_TAKE_OFF) {
- RequestTakeOffClearance("USER");
- }
-}
-
-// **************** RESPONSE FUNCTIONS ****************
-
-void FGTower::Respond() {
- //cout << "\nEntering Respond, responseID = " << responseID << endl;
- TowerPlaneRec* t = FindPlane(responseID);
- if(t) {
- // This will grow!!!
- if(t->vfrArrivalReported && !t->vfrArrivalAcknowledged) {
- //cout << "Tower " << ident << " is responding to VFR arrival reported...\n";
- // Testing - hardwire straight in for now
- string trns = t->plane.callsign;
- trns += " ";
- trns += name;
- trns += " Tower,";
- // Should we clear staight in or for downwind entry?
- // For now we'll clear straight in if greater than 1km from a line drawn through the threshold perpendicular to the rwy.
- // Later on we might check the actual heading and direct some of those to enter on downwind or base.
- Point3D op = ortho.ConvertToLocal(t->pos);
- float gp = fgGetFloat("/gear/gear/position-norm");
- if(gp < 1)
- t->gearWasUp = true; // This will be needed on final to tell "Gear down, ready to land."
- if(op.y() < -1000) {
- trns += " Report three mile straight-in runway ";
- t->opType = STRAIGHT_IN;
- if(t->isUser) {
- current_atcdialog->add_entry(ident, "@CS @MI mile final runway @RW@GR", "Report Final", TOWER, (int)USER_REPORT_3_MILE_FINAL);
- } else {
- t->planePtr->RegisterTransmission(14);
- }
- } else {
- // For now we'll just request reporting downwind.
- // TODO - In real life something like 'report 2 miles southwest right downwind rwy 19R' might be used
- // but I'm not sure how to handle all permutations of which direction to tell to report from yet.
- trns += " Report ";
- //cout << "Responding, rwy.patterDirection is " << rwy.patternDirection << '\n';
- trns += ((rwy.patternDirection == 1) ? "right " : "left ");
- trns += "downwind runway ";
- t->opType = CIRCUIT;
- // leave it in the app list until it gets into pattern though.
- if(t->isUser) {
- current_atcdialog->add_entry(ident, "@AP Tower, @CS Downwind @RW", "Report Downwind", TOWER, (int)USER_REPORT_DOWNWIND);
- } else {
- t->planePtr->RegisterTransmission(15);
- }
- }
- trns += ConvertRwyNumToSpokenString(activeRwy);
- if(_display) {
- pending_transmission = trns;
- Transmit();
- } else {
- //cout << "Not displaying, trns was " << trns << '\n';
- }
- t->vfrArrivalAcknowledged = true;
- } else if(t->downwindReported) {
- //cout << "Tower " << ident << " is responding to downwind reported...\n";
- ProcessDownwindReport(t);
- t->downwindReported = false;
- } else if(t->lineUpReported) {
- string trns = t->plane.callsign;
- if(rwyOccupied) {
- double f = globals->get_ATC_mgr()->GetFrequency(ident, ATIS) / 100.0;
- string wtr;
- if(!f) {
- wtr = ", " + GetWeather();
- }
- trns += " Cleared for take-off" + wtr;
- t->clearedToTakeOff = true;
- } else {
- if(!OnAnyRunway(Point3D(user_lon_node->getDoubleValue(), user_lat_node->getDoubleValue(), 0.0), true)) {
- // TODO: Check if any AI Planes on final and tell something like: "After the landing CALLSIGN line up runway two eight right"
- trns += " Line up runway " + ConvertRwyNumToSpokenString(activeRwy);
- t->clearedToTakeOff = false;
- current_atcdialog->add_entry(ident, "@CS @TO", "Report ready for take-off", TOWER, (int)USER_REQUEST_TAKE_OFF);
-
- } else {
- sg_srandom_time();
- if((int(sg_random() * 10) + 1) != 3) {
- t->clearedToTakeOff = true;
- trns += " Cleared immediate take-off ";
- } else {
- t->clearedToTakeOff = false;
- trns += " Negative, departure runway " + ConvertRwyNumToSpokenString(activeRwy);
- }
- }
- }
- if(_display) {
- pending_transmission = trns;
- Transmit();
- } else {
- //cout << "Not displaying, trns was " << trns << '\n';
- }
- t->lineUpReported = false;
- } else if(t->holdShortReported) {
- //cout << "Tower " << ident << " is reponding to holdShortReported...\n";
- if(t->nextOnRwy) {
- if(rwyOccupied) { // TODO - ought to add a sanity check that it isn't this plane only on the runway (even though it shouldn't be!!)
- // Do nothing for now - consider acknowloging hold short eventually
- } else {
- ClearHoldingPlane(t);
- t->leg = TAKEOFF_ROLL;
- rwyList.push_back(t);
- rwyListItr = rwyList.begin();
- rwyOccupied = true;
- // WARNING - WE ARE ASSUMING ONLY ONE PLANE REPORTING HOLD AT A TIME BELOW
- // FIXME TODO - FIX THIS!!!
- if(!holdList.empty()) {
- if(holdListItr == holdList.end()) {
- holdListItr = holdList.begin();
- }
- holdList.erase(holdListItr);
- holdListItr = holdList.begin();
- }
- }
- } else {
- // Tell him to hold and what position he is.
- // Not currently sure under which circumstances we do or don't bother transmitting this.
- string trns = t->plane.callsign;
- trns += " hold position";
- if(_display) {
- pending_transmission = trns;
- Transmit();
- }
- // TODO - add some idea of what traffic is blocking him.
- }
- t->holdShortReported = false;
- } else if(t->finalReported && !(t->finalAcknowledged)) {
- //cout << "Tower " << ident << " is responding to finalReported...\n";
- bool disp = true;
- string trns = t->plane.callsign;
- //cout << (t->nextOnRwy ? "Next on rwy " : "Not next!! ");
- //cout << (rwyOccupied ? "RWY OCCUPIED!!\n" : "Rwy not occupied\n");
- if(t->nextOnRwy && !rwyOccupied && !(t->instructedToGoAround)) {
- if(t->landingType == FULL_STOP) {
- trns += " cleared to land ";
- } else {
- double f = globals->get_ATC_mgr()->GetFrequency(ident, ATIS) / 100.0;
- string wtr;
- if(!f) {
- wtr = ", " + GetWeather();
- } else {
- wtr = ", runway " + ConvertRwyNumToSpokenString(activeRwy);
- }
- trns += " cleared to land" + wtr;
- }
- // TODO - add winds
- t->clearedToLand = true;
- // Maybe remove report downwind from menu here as well incase user didn't bother to?
- if(t->isUser) {
- //cout << "ADD VACATED B\n";
- // Put going around at the top (and hence default) since that'll be more desperate,
- // or put rwy vacated at the top since that'll be more common?
- current_atcdialog->add_entry(ident, "@CS Going Around", "Report going around", TOWER, USER_REPORT_GOING_AROUND);
- current_atcdialog->add_entry(ident, "@CS Clear of the runway", "Report runway vacated", TOWER, USER_REPORT_RWY_VACATED);
- } else {
- t->planePtr->RegisterTransmission(7);
- }
- } else if(t->eta < 20) {
- // Do nothing - we'll be telling it to go around in less than 10 seconds if the
- // runway doesn't clear so no point in calling "continue approach".
- disp = false;
- } else {
- trns += " continue approach";
- trns += " and report ";
- trns += ((rwy.patternDirection == 1) ? "right " : "left ");
- trns += "downwind runway " + ConvertRwyNumToSpokenString(activeRwy);
- t->opType = CIRCUIT;
- if(t->isUser) {
- current_atcdialog->add_entry(ident, "@AP Tower, @CS Downwind @RW", "Report Downwind", TOWER, (int)USER_REPORT_DOWNWIND);
- } else {
- t->planePtr->RegisterTransmission(15);
- }
- t->clearedToLand = false;
- }
- if(_display && disp) {
- pending_transmission = trns;
- Transmit();
- }
- t->finalAcknowledged = true;
- } else if(t->rwyVacatedReported && !(t->rwyVacatedAcknowledged)) {
- ProcessRunwayVacatedReport(t);
- t->rwyVacatedAcknowledged = true;
- }
- }
- //freqClear = true; // FIXME - set this to come true after enough time to render the message
- _releaseCounter = 0.0;
- _releaseTime = 5.5;
- _runReleaseCounter = true;
- //cout << "Done Respond\n" << endl;
-}
-
-void FGTower::ProcessDownwindReport(TowerPlaneRec* t) {
- int i = 1;
- int a = 0; // Count of preceding planes on approach
- bool cf = false; // conflicting traffic on final
- bool cc = false; // preceding traffic in circuit
- TowerPlaneRec* tc = NULL;
- for(tower_plane_rec_list_iterator twrItr = circuitList.begin(); twrItr != circuitList.end(); twrItr++) {
- if((*twrItr)->plane.callsign == responseID) break;
- tc = *twrItr;
- ++i;
- }
- if(i > 1) { cc = true; }
- doThresholdETACalc();
- TowerPlaneRec* tf = NULL;
- for(tower_plane_rec_list_iterator twrItr = appList.begin(); twrItr != appList.end(); twrItr++) {
- if((*twrItr)->eta < (t->eta + 45) && strcmp((*twrItr)->plane.callsign.c_str(), t->plane.callsign.c_str()) != 0) { // don't let ATC ask you to follow yourself
- a++;
- tf = *twrItr;
- cf = true;
- // This should set the flagged plane to be the last conflicting one, and hence the one to follow.
- // It ignores the fact that we might have problems slotting into the approach traffic behind it -
- // eventually we'll need some fancy algorithms for that!
- }
- }
- string trns = t->plane.callsign;
- trns += " Number ";
- trns += ConvertNumToSpokenDigits(i + a);
- // This assumes that the number spoken is landing position, not circuit position, since some of the traffic might be on straight-in final.
- trns += " ";
- TowerPlaneRec* tt = NULL;
- if((i == 1) && rwyList.empty() && (t->nextOnRwy) && (!cf)) { // Unfortunately nextOnRwy currently doesn't handle circuit/straight-in ordering properly at present, hence the cf check below.
- trns += "Cleared to land"; // TODO - clear for the option if appropriate
- t->clearedToLand = true;
- if(!t->isUser) t->planePtr->RegisterTransmission(7);
- } else if((i+a) > 1) {
- //First set tt to point to the correct preceding plane - final or circuit
- if(tc && tf) {
- tt = (tf->eta < tc->eta ? tf : tc);
- } else if(tc) {
- tt = tc;
- } else if(tf) {
- tt = tf;
- } else {
- // We should never get here!
- SG_LOG(SG_ATC, SG_ALERT, "ALERT - Logic error in FGTower::ProcessDownwindReport");
- return;
- }
- trns += "Follow the ";
- string s = tt->plane.callsign;
- int p = s.find('-');
- s = s.substr(0,p);
- trns += s;
- if((tt->opType) == CIRCUIT) {
- PatternLeg leg;
- if(tt->isUser) {
- leg = tt->leg;
- } else {
- leg = tt->planePtr->GetLeg();
- }
- if(leg == FINAL) {
- trns += " on final";
- } else if(leg == TURN4) {
- trns += " turning final";
- } else if(leg == BASE) {
- trns += " on base";
- } else if(leg == TURN3) {
- trns += " turning base";
- }
- } else {
- double miles_out = CalcDistOutMiles(tt);
- if(miles_out < 2) {
- trns += " on short final";
- } else {
- trns += " on ";
- trns += ConvertNumToSpokenDigits((int)miles_out);
- trns += " mile final";
- }
- }
- }
- if(_display) {
- pending_transmission = trns;
- Transmit();
- }
- if(t->isUser) {
- if(t->opType == TTT_UNKNOWN) t->opType = CIRCUIT;
- //cout << "ADD VACATED A\n";
- // Put going around at the top (and hence default) since that'll be more desperate,
- // or put rwy vacated at the top since that'll be more common?
- //cout << "ident = " << ident << ", adding go-around option\n";
- current_atcdialog->add_entry(ident, "@CS Going Around", "Report going around", TOWER, USER_REPORT_GOING_AROUND);
- current_atcdialog->add_entry(ident, "@CS Clear of the runway", "Report runway vacated", TOWER, USER_REPORT_RWY_VACATED);
- }
-}
-
-void FGTower::ProcessRunwayVacatedReport(TowerPlaneRec* t) {
- //cout << "Processing rwy vacated...\n";
- if(t->isUser) current_atcdialog->remove_entry(ident, USER_REPORT_GOING_AROUND, TOWER);
- string trns = t->plane.callsign;
- if(separateGround) {
- trns += " Contact ground on ";
- double f = globals->get_ATC_mgr()->GetFrequency(ident, GROUND) / 100.0;
- char buf[10];
- sprintf(buf, "%.2f", f);
- trns += buf;
- trns += " Good Day";
- if(!t->isUser) t->planePtr->RegisterTransmission(5);
- } else {
- // Cop-out!!
- trns += " cleared for taxi to general aviation parking";
- if(!t->isUser) t->planePtr->RegisterTransmission(6); // TODO - this is a mega-hack!!
- }
- //cout << "trns = " << trns << '\n';
- if(_display) {
- pending_transmission = trns;
- Transmit();
- }
- RemoveFromRwyList(t->plane.callsign);
- AddToVacatedList(t);
- // Maybe we should check that the plane really *has* vacated the runway!
-}
-
-// *********** END RESPONSE FUNCTIONS *****************
-
-// Currently this assumes we *are* next on the runway and doesn't check for planes about to land -
-// this should be done prior to calling this function.
-void FGTower::ClearHoldingPlane(TowerPlaneRec* t) {
- //cout << "Entering ClearHoldingPlane..." << endl;
- // Lets Roll !!!!
- string trns = t->plane.callsign;
- //if(departed plane < some threshold in time away) {
- if(0) { // FIXME
- //if(timeSinceLastDeparture <= 60.0 && departed == true) {
- trns += " line up runway " + ConvertRwyNumToSpokenString(activeRwy);
- t->clearedToLineUp = true;
- t->planePtr->RegisterTransmission(3); // cleared to line-up
- //} else if(arriving plane < some threshold away) {
- } else if(GetTrafficETA(2) < 150.0 && (timeSinceLastDeparture > 60.0 || departed == false)) { // Hack - hardwired time
- trns += " cleared immediate take-off";
- if(trafficList.size()) {
- tower_plane_rec_list_iterator trfcItr = trafficList.begin();
- trfcItr++; // At the moment the holding plane should be first in trafficList.
- // Note though that this will break if holding planes aren't put in trafficList in the future.
- TowerPlaneRec* trfc = *trfcItr;
- trns += "... traffic is";
- switch(trfc->plane.type) {
- case UNKNOWN:
- break;
- case GA_SINGLE:
- trns += " a Cessna"; // TODO - add ability to specify actual plane type somewhere
- break;
- case GA_HP_SINGLE:
- trns += " a Piper";
- break;
- case GA_TWIN:
- trns += " a King-air";
- break;
- case GA_JET:
- trns += " a Learjet";
- break;
- case MEDIUM:
- trns += " a Regional";
- break;
- case HEAVY:
- trns += " a Heavy";
- break;
- case MIL_JET:
- trns += " Military";
- break;
- }
- //if(trfc->opType == STRAIGHT_IN || trfc->opType == TTT_UNKNOWN) {
- if(trfc->opType == STRAIGHT_IN) {
- double miles_out = CalcDistOutMiles(trfc);
- if(miles_out < 2) {
- trns += " on final";
- } else {
- trns += " on ";
- trns += ConvertNumToSpokenDigits((int)miles_out);
- trns += " mile final";
- }
- } else if(trfc->opType == CIRCUIT) {
- //cout << "Getting leg of " << trfc->plane.callsign << '\n';
- switch(trfc->leg) {
- case FINAL:
- trns += " on final";
- break;
- case TURN4:
- trns += " turning final";
- break;
- case BASE:
- trns += " on base";
- break;
- case TURN3:
- trns += " turning base";
- break;
- case DOWNWIND:
- trns += " in circuit"; // At the moment the user plane is generally flagged as unknown opType when downwind incase its a downwind departure which means we won't get here.
- break;
- // And to eliminate compiler warnings...
- case TAKEOFF_ROLL: break;
- case CLIMBOUT: break;
- case TURN1: break;
- case CROSSWIND: break;
- case TURN2: break;
- case LANDING_ROLL: break;
- case LEG_UNKNOWN: break;
- }
- }
- } else {
- // By definition there should be some arriving traffic if we're cleared for immediate takeoff
- SG_LOG(SG_ATC, SG_WARN, "Warning: Departing traffic cleared for *immediate* take-off despite no arriving traffic in FGTower");
- }
- t->clearedToTakeOff = true;
- t->planePtr->RegisterTransmission(4); // cleared to take-off - TODO differentiate between immediate and normal take-off
- departed = false;
- timeSinceLastDeparture = 0.0;
- } else {
- //} else if(timeSinceLastDeparture > 60.0 || departed == false) { // Hack - test for timeSinceLastDeparture should be in lineup block eventually
- trns += " cleared for take-off";
- // TODO - add traffic is... ?
- t->clearedToTakeOff = true;
- t->planePtr->RegisterTransmission(4); // cleared to take-off
- departed = false;
- timeSinceLastDeparture = 0.0;
- }
- if(_display) {
- pending_transmission = trns;
- Transmit();
- }
- //cout << "Done ClearHoldingPlane " << endl;
-}
-
-
-// ***************************************************************************************
-// ********** Functions to periodically check what the various traffic is doing **********
-
-// Do one plane from the hold list
-void FGTower::CheckHoldList(double dt) {
- //cout << "Entering CheckHoldList..." << endl;
- if(!holdList.empty()) {
- //cout << "*holdListItr = " << *holdListItr << endl;
- if(holdListItr == holdList.end()) {
- holdListItr = holdList.begin();
- }
- //cout << "*holdListItr = " << *holdListItr << endl;
- //Process(*holdListItr);
- TowerPlaneRec* t = *holdListItr;
- //cout << "t = " << t << endl;
- if(t->holdShortReported) {
- // NO-OP - leave it to the response handler.
- } else { // not responding to report, but still need to clear if clear
- if(t->nextOnRwy) {
- //cout << "departed = " << departed << '\n';
- //cout << "timeSinceLastDeparture = " << timeSinceLastDeparture << '\n';
- if(rwyOccupied) {
- RemoveAllUserDialogOptions();
- current_atcdialog->add_entry(ident, "@CS Ready for take-off", "Request take-off clearance", TOWER, (int)USER_REQUEST_TAKE_OFF);
- } else if(timeSinceLastDeparture <= 60.0 && departed == true) {
- // Do nothing - this is a bit of a hack - should maybe do line up be ready here
- } else {
- ClearHoldingPlane(t);
- t->leg = TAKEOFF_ROLL;
- rwyList.push_back(t);
- rwyListItr = rwyList.begin();
- rwyOccupied = true;
- holdList.erase(holdListItr);
- holdListItr = holdList.begin();
- if (holdList.empty())
- return;
- }
- }
- // TODO - rationalise the considerable code duplication above!
- }
- ++holdListItr;
- }
- //cout << "Done CheckHoldList" << endl;
-}
-
-// do the ciruit list
-void FGTower::CheckCircuitList(double dt) {
- //cout << "Entering CheckCircuitList..." << endl;
- // Clear the constraints - we recalculate here.
- base_leg_pos = 0.0;
- downwind_leg_pos = 0.0;
- crosswind_leg_pos = 0.0;
-
- if(!circuitList.empty()) { // Do one plane from the circuit
- if(circuitListItr == circuitList.end()) {
- circuitListItr = circuitList.begin();
- }
- TowerPlaneRec* t = *circuitListItr;
- //cout << ident << ' ' << circuitList.size() << ' ' << t->plane.callsign << " " << t->leg << " eta " << t->eta << '\n';
- if(t->isUser) {
- t->pos.setlon(user_lon_node->getDoubleValue());
- t->pos.setlat(user_lat_node->getDoubleValue());
- t->pos.setelev(user_elev_node->getDoubleValue());
- //cout << ident << ' ' << circuitList.size() << ' ' << t->plane.callsign << " " << t->leg << " eta " << t->eta << '\n';
- } else {
- t->pos = t->planePtr->GetPos(); // We should probably only set the pos's on one walk through the traffic list in the update function, to save a few CPU should we end up duplicating this.
- t->landingType = t->planePtr->GetLandingOption();
- //cout << "AI plane landing option is " << t->landingType << '\n';
- }
- Point3D tortho = ortho.ConvertToLocal(t->pos);
- if(t->isUser) {
- // Need to figure out which leg he's on
- //cout << "rwy.hdg = " << rwy.hdg << " user hdg = " << user_hdg_node->getDoubleValue();
- double ho = GetAngleDiff_deg(user_hdg_node->getDoubleValue(), rwy.hdg);
- //cout << " ho = " << ho << " abs(ho = " << abs(ho) << '\n';
- // TODO FIXME - get the wind and convert this to track, or otherwise use track somehow!!!
- // If it's gusty might need to filter the value, although we are leaving 30 degrees each way leeway!
- if(fabs(ho) < 30) {
- // could be either takeoff, climbout or landing - check orthopos.y
- //cout << "tortho.y = " << tortho.y() << '\n';
- if((tortho.y() < 0) || (t->leg == TURN4) || (t->leg == FINAL)) {
- t->leg = FINAL;
- //cout << "Final\n";
- } else {
- t->leg = CLIMBOUT; // TODO - check elev wrt. apt elev to differentiate takeoff roll and climbout
- //cout << "Climbout\n";
- // If it's the user we may be unsure of his/her intentions.
- // (Hopefully the AI planes won't try confusing the sim!!!)
- //cout << "tortho.y = " << tortho.y() << '\n';
- if(t->opType == TTT_UNKNOWN) {
- if(tortho.y() > 5000) {
- // 5 km out from threshold - assume it's a departure
- t->opType = OUTBOUND; // TODO - could check if the user has climbed significantly above circuit altitude as well.
- // Since we are unknown operation we should be in depList already.
- //cout << ident << " Removing user from circuitList (TTT_UNKNOWN)\n";
- circuitListItr = circuitList.erase(circuitListItr);
- RemoveFromTrafficList(t->plane.callsign);
- if (circuitList.empty())
- return;
- }
- } else if(t->opType == CIRCUIT) {
- if(tortho.y() > 10000) {
- // 10 km out - assume the user has abandoned the circuit!!
- t->opType = OUTBOUND;
- depList.push_back(t);
- depListItr = depList.begin();
- //cout << ident << " removing user from circuitList (CIRCUIT)\n";
- circuitListItr = circuitList.erase(circuitListItr);
- if (circuitList.empty())
- return;
- }
- }
- }
- } else if(fabs(ho) < 60) {
- // turn1 or turn 4
- // TODO - either fix or doublecheck this hack by looking at heading and pattern direction
- if((t->leg == CLIMBOUT) || (t->leg == TURN1)) {
- t->leg = TURN1;
- //cout << "Turn1\n";
- } else {
- t->leg = TURN4;
- //cout << "Turn4\n";
- }
- } else if(fabs(ho) < 120) {
- // crosswind or base
- // TODO - either fix or doublecheck this hack by looking at heading and pattern direction
- if((t->leg == TURN1) || (t->leg == CROSSWIND)) {
- t->leg = CROSSWIND;
- //cout << "Crosswind\n";
- } else {
- t->leg = BASE;
- //cout << "Base\n";
- }
- } else if(fabs(ho) < 150) {
- // turn2 or turn 3
- // TODO - either fix or doublecheck this hack by looking at heading and pattern direction
- if((t->leg == CROSSWIND) || (t->leg == TURN2)) {
- t->leg = TURN2;
- //cout << "Turn2\n";
- } else {
- t->leg = TURN3;
- // Probably safe now to assume the user is flying a circuit
- t->opType = CIRCUIT;
- //cout << "Turn3\n";
- }
- } else {
- // downwind
- t->leg = DOWNWIND;
- //cout << "Downwind\n";
- }
- if(t->leg == FINAL) {
- if(OnActiveRunway(t->pos)) {
- t->leg = LANDING_ROLL;
- }
- }
- } else {
- t->leg = t->planePtr->GetLeg();
- }
-
- // Set the constraints IF this is the first plane in the circuit
- // TODO - at the moment we're constraining plane 2 based on plane 1 - this won't (or might not) work for 3 planes in the circuit!!
- if(circuitListItr == circuitList.begin()) {
- switch(t->leg) {
- case FINAL:
- // Base leg must be at least as far out as the plane is - actually possibly not necessary for separation, but we'll use that for now.
- base_leg_pos = tortho.y();
- //cout << "base_leg_pos = " << base_leg_pos << '\n';
- break;
- case TURN4:
- // Fall through to base
- case BASE:
- base_leg_pos = tortho.y();
- //cout << "base_leg_pos = " << base_leg_pos << '\n';
- break;
- case TURN3:
- // Fall through to downwind
- case DOWNWIND:
- // Only have the downwind leg pos as turn-to-base constraint if more negative than we already have.
- base_leg_pos = (tortho.y() < base_leg_pos ? tortho.y() : base_leg_pos);
- //cout << "base_leg_pos = " << base_leg_pos;
- downwind_leg_pos = tortho.x(); // Assume that a following plane can simply be constrained by the immediately in front downwind plane
- //cout << " downwind_leg_pos = " << downwind_leg_pos << '\n';
- break;
- case TURN2:
- // Fall through to crosswind
- case CROSSWIND:
- crosswind_leg_pos = tortho.y();
- //cout << "crosswind_leg_pos = " << crosswind_leg_pos << '\n';
- t->instructedToGoAround = false;
- break;
- case TURN1:
- // Fall through to climbout
- case CLIMBOUT:
- // Only use current by constraint as largest
- crosswind_leg_pos = (tortho.y() > crosswind_leg_pos ? tortho.y() : crosswind_leg_pos);
- //cout << "crosswind_leg_pos = " << crosswind_leg_pos << '\n';
- break;
- case TAKEOFF_ROLL:
- break;
- case LEG_UNKNOWN:
- break;
- case LANDING_ROLL:
- break;
- default:
- break;
- }
- }
-
- if(t->leg == FINAL && !(t->instructedToGoAround)) {
- doThresholdETACalc();
- doThresholdUseOrder();
- /*
- if(t->isUser) {
- cout << "Checking USER on final... ";
- cout << "eta " << t->eta;
- if(t->clearedToLand) cout << " cleared to land\n";
- }
- */
- //cout << "YES FINAL, t->eta = " << t->eta << ", rwyList.size() = " << rwyList.size() << '\n';
- if(t->landingType == FULL_STOP) {
- t->opType = INBOUND;
- //cout << "\n******** SWITCHING TO INBOUND AT POINT AAA *********\n\n";
- }
- if(t->eta < 12 && rwyList.size()) {
- // TODO - need to make this more sophisticated
- // eg. is the plane accelerating down the runway taking off [OK],
- // or stationary near the start [V. BAD!!].
- // For now this should stop the AI plane landing on top of the user.
- tower_plane_rec_list_iterator twrItr;
- twrItr = rwyList.begin();
- TowerPlaneRec* tpr = *twrItr;
- if(strcmp(tpr->plane.callsign.c_str(), t->plane.callsign.c_str()) == 0
- && rwyList.size() == 1) {
- // Fixing bug when ATC says that we must go around because of traffic on rwy
- // but that traffic is our plane! In future we can use this expression
- // for other ATC-messages like "On ground at 46, vacate left."
-
- } else {
- string trns = t->plane.callsign;
- trns += " GO AROUND TRAFFIC ON RUNWAY I REPEAT GO AROUND";
- pending_transmission = trns;
- ImmediateTransmit();
- t->instructedToGoAround = true;
- t->clearedToLand = false;
- // Assume it complies!!!
- t->opType = CIRCUIT;
- t->leg = CLIMBOUT;
- if(t->planePtr) {
- //cout << "Registering Go-around transmission with AI plane\n";
- t->planePtr->RegisterTransmission(13);
- }
- }
- } else if(!t->clearedToLand) {
- // The whip through the appList is a hack since currently t->nextOnRwy doesn't always work
- // TODO - fix this!
- bool cf = false;
- for(tower_plane_rec_list_iterator twrItr = appList.begin(); twrItr != appList.end(); twrItr++) {
- if((*twrItr)->eta < t->eta) {
- cf = true;
- }
- }
- if(t->nextOnRwy && !cf) {
- if(!rwyList.size()) {
- string trns = t->plane.callsign;
- trns += " Cleared to land";
- pending_transmission = trns;
- Transmit();
- //if(t->isUser) cout << "Transmitting cleared to Land!!!\n";
- t->clearedToLand = true;
- if(!t->isUser) {
- t->planePtr->RegisterTransmission(7);
- }
- }
- } else {
- //if(t->isUser) cout << "Not next\n";
- }
- }
- } else if(t->leg == LANDING_ROLL) {
- //cout << t->plane.callsign << " has landed - adding to rwyList\n";
- rwyList.push_front(t);
- // TODO - if(!clearedToLand) shout something!!
- t->clearedToLand = false;
- RemoveFromTrafficList(t->plane.callsign);
- if(t->isUser) {
- t->opType = TTT_UNKNOWN;
- } // TODO - allow the user to specify opType via ATC menu
- //cout << ident << " Removing " << t->plane.callsign << " from circuitList..." << endl;
- circuitListItr = circuitList.erase(circuitListItr);
- if(circuitListItr == circuitList.end() ) {
- circuitListItr = circuitList.begin();
- // avoid increment of circuitListItr (would increment to second element, or crash if no element left)
- return;
- }
- }
- ++circuitListItr;
- }
- //cout << "Done CheckCircuitList" << endl;
-}
-
-// Do the runway list - we'll do the whole runway list since it's important and there'll never be many planes on the rwy at once!!
-// FIXME - at the moment it looks like we're only doing the first plane from the rwy list.
-// (However, at the moment there should only be one airplane on the rwy at once, until we
-// start allowing planes to line up whilst previous arrival clears the rwy.)
-void FGTower::CheckRunwayList(double dt) {
- //cout << "Entering CheckRunwayList..." << endl;
- if(rwyOccupied) {
- if(!rwyList.size()) {
- rwyOccupied = false;
- } else {
- rwyListItr = rwyList.begin();
- TowerPlaneRec* t = *rwyListItr;
- if(t->isUser) {
- t->pos.setlon(user_lon_node->getDoubleValue());
- t->pos.setlat(user_lat_node->getDoubleValue());
- t->pos.setelev(user_elev_node->getDoubleValue());
- } else {
- t->pos = t->planePtr->GetPos(); // We should probably only set the pos's on one walk through the traffic list in the update function, to save a few CPU should we end up duplicating this.
- }
- bool on_rwy = OnActiveRunway(t->pos);
- if(!on_rwy) {
- // TODO - for all of these we need to check what the user is *actually* doing!
- if((t->opType == INBOUND) || (t->opType == STRAIGHT_IN)) {
- //cout << "Tower " << ident << " is removing plane " << t->plane.callsign << " from rwy list (vacated)\n";
- //cout << "Size of rwylist was " << rwyList.size() << '\n';
- //cout << "Size of vacatedList was " << vacatedList.size() << '\n';
- RemoveFromRwyList(t->plane.callsign);
- AddToVacatedList(t);
- //cout << "Size of rwylist is " << rwyList.size() << '\n';
- //cout << "Size of vacatedList is " << vacatedList.size() << '\n';
- // At the moment we wait until Runway Vacated is reported by the plane before telling to contact ground etc.
- // It's possible we could be a bit more proactive about this.
- } else if(t->opType == OUTBOUND) {
- depList.push_back(t);
- depListItr = depList.begin();
- rwyList.pop_front();
- departed = true;
- timeSinceLastDeparture = 0.0;
- } else if(t->opType == CIRCUIT) {
- //cout << ident << " adding " << t->plane.callsign << " to circuitList" << endl;
- circuitList.push_back(t);
- circuitListItr = circuitList.begin();
- AddToTrafficList(t);
- rwyList.pop_front();
- departed = true;
- timeSinceLastDeparture = 0.0;
- } else if(t->opType == TTT_UNKNOWN) {
- depList.push_back(t);
- depListItr = depList.begin();
- //cout << ident << " adding " << t->plane.callsign << " to circuitList" << endl;
- circuitList.push_back(t);
- circuitListItr = circuitList.begin();
- AddToTrafficList(t);
- rwyList.pop_front();
- departed = true;
- timeSinceLastDeparture = 0.0; // TODO - we need to take into account that the user might taxi-in when flagged opType UNKNOWN - check speed/altitude etc to make decision as to what user is up to.
- } else {
- // HELP - we shouldn't ever get here!!!
- }
- }
- }
- }
- //cout << "Done CheckRunwayList" << endl;
-}
-
-// Do one plane from the approach list
-void FGTower::CheckApproachList(double dt) {
- //cout << "CheckApproachList called for " << ident << endl;
- //cout << "AppList.size is " << appList.size() << endl;
- if(!appList.empty()) {
- if(appListItr == appList.end()) {
- appListItr = appList.begin();
- }
- TowerPlaneRec* t = *appListItr;
- //cout << "t = " << t << endl;
- //cout << "Checking " << t->plane.callsign << endl;
- if(t->isUser) {
- t->pos.setlon(user_lon_node->getDoubleValue());
- t->pos.setlat(user_lat_node->getDoubleValue());
- t->pos.setelev(user_elev_node->getDoubleValue());
- } else {
- // TODO - set/update the position if it's an AI plane
- }
- doThresholdETACalc(); // We need this here because planes in the lists are not guaranteed to *always* have the correct ETA
- //cout << "eta is " << t->eta << ", rwy is " << (rwyList.size() ? "occupied " : "clear ") << '\n';
- Point3D tortho = ortho.ConvertToLocal(t->pos);
- if(t->eta < 12 && rwyList.size() && !(t->instructedToGoAround)) {
- // TODO - need to make this more sophisticated
- // eg. is the plane accelerating down the runway taking off [OK],
- // or stationary near the start [V. BAD!!].
- // For now this should stop the AI plane landing on top of the user.
- tower_plane_rec_list_iterator twrItr;
- twrItr = rwyList.begin();
- TowerPlaneRec* tpr = *twrItr;
- if(strcmp ( tpr->plane.callsign.c_str(), t->plane.callsign.c_str() ) == 0 && rwyList.size() == 1) {
- // Fixing bug when ATC says that we must go around because of traffic on rwy
- // but that traffic is we! In future we can use this expression
- // for other ATC-messages like "On ground at 46, vacate left."
-
- } else {
- string trns = t->plane.callsign;
- trns += " GO AROUND TRAFFIC ON RUNWAY I REPEAT GO AROUND";
- pending_transmission = trns;
- ImmediateTransmit();
- t->instructedToGoAround = true;
- t->clearedToLand = false;
- t->nextOnRwy = false; // But note this is recalculated so don't rely on it
- // Assume it complies!!!
- t->opType = CIRCUIT;
- t->leg = CLIMBOUT;
- if(!t->isUser) {
- if(t->planePtr) {
- //cout << "Registering Go-around transmission with AI plane\n";
- t->planePtr->RegisterTransmission(13);
- }
- } else {
- // TODO - add Go-around ack to comm options,
- // remove report rwy vacated. (possibly).
- }
- }
- } else if(t->isUser && t->eta < 90 && tortho.y() > -2500 && t->clearedToLand && t->gearUpReported == false) {
- // Check if gear up or down
- double gp = fgGetFloat("/gear/gear/position-norm");
- if(gp < 1) {
- string trnsm = t->plane.callsign;
- sg_srandom_time();
- int rnd = int(sg_random() * 2) + 1;
- if(rnd == 2) { // Random message for more realistic ATC ;)
- trnsm += ", LANDING GEAR APPEARS UP!";
- } else {
- trnsm += ", Check wheels down and locked.";
- }
- pending_transmission = trnsm;
- ImmediateTransmit();
- t->gearUpReported = true;
- }
- } else if(t->eta < 90 && !t->clearedToLand) {
- //doThresholdETACalc();
- doThresholdUseOrder();
- // The whip through the appList is a hack since currently t->nextOnRwy doesn't always work
- // TODO - fix this!
- bool cf = false;
- for(tower_plane_rec_list_iterator twrItr = appList.begin(); twrItr != appList.end(); twrItr++) {
- if((*twrItr)->eta < t->eta) {
- cf = true;
- }
- }
- if(t->nextOnRwy && !cf) {
- if(!rwyList.size()) {
- string trns = t->plane.callsign;
- trns += " Cleared to land";
- pending_transmission = trns;
- Transmit();
- //if(t->isUser) cout << "Transmitting cleared to Land!!!\n";
- t->clearedToLand = true;
- if(!t->isUser) {
- t->planePtr->RegisterTransmission(7);
- }
- }
- } else {
- //if(t->isUser) cout << "Not next\n";
- }
- }
-
- // Check for landing...
- bool landed = false;
- if(!t->isUser) {
- if(t->planePtr) {
- if(t->planePtr->GetLeg() == LANDING_ROLL) {
- landed = true;
- }
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "WARNING - not user and null planePtr in CheckApproachList!");
- }
- } else { // user
- if(OnActiveRunway(t->pos)) {
- landed = true;
- }
- }
-
- if(landed) {
- // Duplicated in CheckCircuitList - must be able to rationalise this somehow!
- //cout << "A " << t->plane.callsign << " has landed, adding to rwyList...\n";
- rwyList.push_front(t);
- // TODO - if(!clearedToLand) shout something!!
- t->clearedToLand = false;
- RemoveFromTrafficList(t->plane.callsign);
- //if(t->isUser) {
- // t->opType = TTT_UNKNOWN;
- //} // TODO - allow the user to specify opType via ATC menu
- appListItr = appList.erase(appListItr);
- if(appListItr == appList.end() ) {
- appListItr = appList.begin();
- }
- if (appList.empty())
- return;
-
- }
-
- ++appListItr;
- }
- //cout << "Done" << endl;
-}
-
-// Do one plane from the departure list
-void FGTower::CheckDepartureList(double dt) {
- if(!depList.empty()) {
- if(depListItr == depList.end()) {
- depListItr = depList.begin();
- }
- TowerPlaneRec* t = *depListItr;
- //cout << "Dep list, checking " << t->plane.callsign;
-
- double distout; // meters
- if(t->isUser) distout = dclGetHorizontalSeparation(Point3D(lon, lat, elev), Point3D(user_lon_node->getDoubleValue(), user_lat_node->getDoubleValue(), user_elev_node->getDoubleValue()));
- else distout = dclGetHorizontalSeparation(Point3D(lon, lat, elev), t->planePtr->GetPos());
- //cout << " distout = " << distout << '\n';
- if(t->isUser && !(t->clearedToTakeOff)) { // HACK - we use clearedToTakeOff to check if ATC already contacted with plane (and cleared take-off) or not
- if(!OnAnyRunway(Point3D(user_lon_node->getDoubleValue(), user_lat_node->getDoubleValue(), 0.0), false)) {
- current_atcdialog->remove_entry(ident, USER_REQUEST_TAKE_OFF, TOWER);
- t->clearedToTakeOff = true; // FIXME
- }
- }
- if(distout > 10000) {
- string trns = t->plane.callsign;
- trns += " You are now clear of my airspace, good day";
- pending_transmission = trns;
- Transmit();
- if(t->isUser) {
- // Change the communication options
- RemoveAllUserDialogOptions();
- //cout << "ADD A\n";
- current_atcdialog->add_entry(ident, "@AP Tower, @CS @MI miles @CD of the airport for full stop@AT", "Contact tower for VFR arrival (full stop)", TOWER, (int)USER_REQUEST_VFR_ARRIVAL_FULL_STOP);
- } else {
- // Send a clear-of-airspace signal
- // TODO - implement this once we actually have departing AI traffic (currently all circuits or arrivals).
- }
- RemovePlane(t->plane.callsign);
- } else {
- ++depListItr;
- }
- }
-}
-
-// ********** End periodic check functions ***********************************************
-// ***************************************************************************************
-
-
-// Remove all dialog options for this tower.
-void FGTower::RemoveAllUserDialogOptions() {
- current_atcdialog->remove_entry(ident, USER_REQUEST_VFR_DEPARTURE, TOWER);
- current_atcdialog->remove_entry(ident, USER_REQUEST_VFR_ARRIVAL, TOWER);
- current_atcdialog->remove_entry(ident, USER_REQUEST_VFR_ARRIVAL_FULL_STOP, TOWER);
- current_atcdialog->remove_entry(ident, USER_REQUEST_VFR_ARRIVAL_TOUCH_AND_GO, TOWER);
- current_atcdialog->remove_entry(ident, USER_REPORT_3_MILE_FINAL, TOWER);
- current_atcdialog->remove_entry(ident, USER_REPORT_DOWNWIND, TOWER);
- current_atcdialog->remove_entry(ident, USER_REPORT_RWY_VACATED, TOWER);
- current_atcdialog->remove_entry(ident, USER_REPORT_GOING_AROUND, TOWER);
- current_atcdialog->remove_entry(ident, USER_REQUEST_TAKE_OFF, TOWER);
-}
-
-// Returns true if positions of crosswind/downwind/base leg turns should be constrained by previous traffic
-// plus the constraint position as a rwy orientated orthopos (meters)
-bool FGTower::GetCrosswindConstraint(double& cpos) {
- if(crosswind_leg_pos != 0.0) {
- cpos = crosswind_leg_pos;
- return(true);
- } else {
- cpos = 0.0;
- return(false);
- }
-}
-bool FGTower::GetDownwindConstraint(double& dpos) {
- if(fabs(downwind_leg_pos) > nominal_downwind_leg_pos) {
- dpos = downwind_leg_pos;
- return(true);
- } else {
- dpos = 0.0;
- return(false);
- }
-}
-bool FGTower::GetBaseConstraint(double& bpos) {
- if(base_leg_pos < nominal_base_leg_pos) {
- bpos = base_leg_pos;
- return(true);
- } else {
- bpos = nominal_base_leg_pos;
- return(false);
- }
-}
-
-
-// Figure out which runways are active.
-// For now we'll just be simple and do one active runway - eventually this will get much more complex
-// This is a private function - public interface to the results of this is through GetActiveRunway
-void FGTower::DoRwyDetails() {
- //cout << "GetRwyDetails called" << endl;
-
- // Based on the airport-id and wind get the active runway
-
- //wind
- double hdg = wind_from_hdg->getDoubleValue();
- double speed = wind_speed_knots->getDoubleValue();
- hdg = (speed == 0.0 ? 270.0 : hdg);
- //cout << "Heading = " << hdg << '\n';
-
- FGRunway runway;
- bool rwyGood = globals->get_runways()->search(ident, int(hdg), &runway);
- if(rwyGood) {
- //cout << "RUNWAY GOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOOD\n";
- activeRwy = runway._rwy_no;
- rwy.rwyID = runway._rwy_no;
- SG_LOG(SG_ATC, SG_INFO, "Active runway for airport " << ident << " is " << activeRwy);
-
- // Get the threshold position
- double other_way = runway._heading - 180.0;
- while(other_way <= 0.0) {
- other_way += 360.0;
- }
- // move to the +l end/center of the runway
- //cout << "Runway center is at " << runway._lon << ", " << runway._lat << '\n';
- Point3D origin = Point3D(runway._lon, runway._lat, aptElev);
- Point3D ref = origin;
- double tshlon, tshlat, tshr;
- double tolon, tolat, tor;
- rwy.length = runway._length * SG_FEET_TO_METER;
- rwy.width = runway._width * SG_FEET_TO_METER;
- geo_direct_wgs_84 ( aptElev, ref.lat(), ref.lon(), other_way,
- rwy.length / 2.0 - 25.0, &tshlat, &tshlon, &tshr );
- geo_direct_wgs_84 ( aptElev, ref.lat(), ref.lon(), runway._heading,
- rwy.length / 2.0 - 25.0, &tolat, &tolon, &tor );
- // Note - 25 meters in from the runway end is a bit of a hack to put the plane ahead of the user.
- // now copy what we need out of runway into rwy
- rwy.threshold_pos = Point3D(tshlon, tshlat, aptElev);
- Point3D takeoff_end = Point3D(tolon, tolat, aptElev);
- //cout << "Threshold position = " << tshlon << ", " << tshlat << ", " << aptElev << '\n';
- //cout << "Takeoff position = " << tolon << ", " << tolat << ", " << aptElev << '\n';
- rwy.hdg = runway._heading;
- // Set the projection for the local area based on this active runway
- ortho.Init(rwy.threshold_pos, rwy.hdg);
- rwy.end1ortho = ortho.ConvertToLocal(rwy.threshold_pos); // should come out as zero
- rwy.end2ortho = ortho.ConvertToLocal(takeoff_end);
-
- // Set the pattern direction
- // TODO - we'll check for a facilities file with this in eventually - for now assume left traffic except
- // for certain circumstances (RH parallel rwy).
- rwy.patternDirection = -1; // Left
- if(rwy.rwyID.size() == 3) {
- rwy.patternDirection = (rwy.rwyID.substr(2,1) == "R" ? 1 : -1);
- }
- //cout << "Doing details, rwy.patterDirection is " << rwy.patternDirection << '\n';
- } else {
- SG_LOG(SG_ATC, SG_ALERT, "Help - can't get good runway in FGTower!!");
- activeRwy = "NN";
- }
-}
-
-
-// Figure out if a given position lies on the active runway
-// Might have to change when we consider more than one active rwy.
-bool FGTower::OnActiveRunway(const Point3D& pt) {
- // TODO - check that the centre calculation below isn't confused by displaced thesholds etc.
- Point3D xyc((rwy.end1ortho.x() + rwy.end2ortho.x())/2.0, (rwy.end1ortho.y() + rwy.end2ortho.y())/2.0, 0.0);
- Point3D xyp = ortho.ConvertToLocal(pt);
-
- //cout << "Length offset = " << fabs(xyp.y() - xyc.y()) << '\n';
- //cout << "Width offset = " << fabs(xyp.x() - xyc.x()) << '\n';
-
- double rlen = rwy.length/2.0 + 5.0;
- double rwidth = rwy.width/2.0;
- double ldiff = fabs(xyp.y() - xyc.y());
- double wdiff = fabs(xyp.x() - xyc.x());
-
- return((ldiff < rlen) && (wdiff < rwidth));
-}
-
-// Figure out if a given position lies on any runway or not
-// Only call this at startup - reading the runways database is expensive and needs to be fixed!
-bool FGTower::OnAnyRunway(const Point3D& pt, bool onGround) {
- ATCData ad;
- double dist = current_commlist->FindClosest(lon, lat, elev, ad, TOWER, 7.0);
- if(dist < 0.0) {
- return(false);
- }
-
- // Based on the airport-id, go through all the runways and check for a point in them
-
- // TODO - do we actually need to search for the airport - surely we already know our ident and
- // can just search runways of our airport???
- //cout << "Airport ident is " << ad.ident << '\n';
- FGRunway runway;
- bool rwyGood = globals->get_runways()->search(ad.ident, &runway);
- if(!rwyGood) {
- SG_LOG(SG_ATC, SG_WARN, "Unable to find any runways for airport ID " << ad.ident << " in FGTower");
- }
- bool on = false;
- while(runway._id == ad.ident) {
- on = OnRunway(pt, runway);
- //cout << "Runway " << runway._rwy_no << ": On = " << (on ? "true\n" : "false\n");
- if(on) {
- if(onGround == false)
- return(true);
- if(runway._rwy_no != "xx")
- return(true);
- }
- globals->get_runways()->next(&runway);
- }
- return(on);
-}
-
-
-// Returns true if successful
-bool FGTower::RemoveFromTrafficList(const string& id) {
- tower_plane_rec_list_iterator twrItr;
- for(twrItr = trafficList.begin(); twrItr != trafficList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- if(tpr->plane.callsign == id) {
- trafficList.erase(twrItr);
- trafficListItr = trafficList.begin();
- return(true);
- }
- }
- SG_LOG(SG_ATC, SG_WARN, "Warning - unable to remove aircraft " << id << " from trafficList in FGTower");
- return(false);
-}
-
-
-// Returns true if successful
-bool FGTower::RemoveFromAppList(const string& id) {
- tower_plane_rec_list_iterator twrItr;
- for(twrItr = appList.begin(); twrItr != appList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- if(tpr->plane.callsign == id) {
- appList.erase(twrItr);
- appListItr = appList.begin();
- return(true);
- }
- }
- //SG_LOG(SG_ATC, SG_WARN, "Warning - unable to remove aircraft " << id << " from appList in FGTower");
- return(false);
-}
-
-// Returns true if successful
-bool FGTower::RemoveFromRwyList(const string& id) {
- tower_plane_rec_list_iterator twrItr;
- for(twrItr = rwyList.begin(); twrItr != rwyList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- if(tpr->plane.callsign == id) {
- rwyList.erase(twrItr);
- rwyListItr = rwyList.begin();
- return(true);
- }
- }
- //SG_LOG(SG_ATC, SG_WARN, "Warning - unable to remove aircraft " << id << " from rwyList in FGTower");
- return(false);
-}
-
-
-// Add a tower plane rec with ETA to the traffic list in the correct position ETA-wise
-// and set nextOnRwy if so.
-// Returns true if this could cause a threshold ETA conflict with other traffic, false otherwise.
-// For planes holding they are put in the first position with time to go, and the return value is
-// true if in the first position (nextOnRwy) and false otherwise.
-// See the comments in FGTower::doThresholdUseOrder for notes on the ordering
-bool FGTower::AddToTrafficList(TowerPlaneRec* t, bool holding) {
- //cout << "ADD: " << trafficList.size();
- //cout << "AddToTrafficList called, currently size = " << trafficList.size() << ", holding = " << holding << endl;
- double separation_time = 90.0; // seconds - this is currently a guess for light plane separation, and includes a few seconds for a holding plane to taxi onto the rwy.
- double departure_sep_time = 60.0; // Separation time behind departing airplanes. Comments above also apply.
- bool conflict = false;
- double lastETA = 0.0;
- bool firstTime = true;
- // FIXME - make this more robust for different plane types eg. light following heavy.
- tower_plane_rec_list_iterator twrItr;
- //twrItr = trafficList.begin();
- //while(1) {
- for(twrItr = trafficList.begin(); twrItr != trafficList.end(); twrItr++) {
- //if(twrItr == trafficList.end()) {
- // cout << " END ";
- // trafficList.push_back(t);
- // return(holding ? firstTime : conflict);
- //} else {
- TowerPlaneRec* tpr = *twrItr;
- if(holding) {
- //cout << (tpr->isUser ? "USER!\n" : "NOT user\n");
- //cout << "tpr->eta - lastETA = " << tpr->eta - lastETA << '\n';
- double dep_allowance = (timeSinceLastDeparture < departure_sep_time ? departure_sep_time - timeSinceLastDeparture : 0.0);
- double slot_time = (firstTime ? separation_time + dep_allowance : separation_time + departure_sep_time);
- // separation_time + departure_sep_time in the above accounts for the fact that the arrival could be touch and go,
- // and if not needs time to clear the rwy anyway.
- if(tpr->eta - lastETA > slot_time) {
- t->nextOnRwy = firstTime;
- trafficList.insert(twrItr, t);
- //cout << "\tH\t" << trafficList.size() << '\n';
- return(firstTime);
- }
- firstTime = false;
- } else {
- if(t->eta < tpr->eta) {
- // Ugg - this one's tricky.
- // It depends on what the two planes are doing and whether there's a conflict what we do.
- if(tpr->eta - t->eta > separation_time) { // No probs, plane 2 can squeeze in before plane 1 with no apparent conflict
- if(tpr->nextOnRwy) {
- tpr->nextOnRwy = false;
- t->nextOnRwy = true;
- }
- trafficList.insert(twrItr, t);
- } else { // Ooops - this ones tricky - we have a potential conflict!
- conflict = true;
- // HACK - just add anyway for now and flag conflict - TODO - FIX THIS using CIRCUIT/STRAIGHT_IN and VFR/IFR precedence rules.
- if(tpr->nextOnRwy) {
- tpr->nextOnRwy = false;
- t->nextOnRwy = true;
- }
- trafficList.insert(twrItr, t);
- }
- //cout << "\tC\t" << trafficList.size() << '\n';
- return(conflict);
- }
- }
- //}
- //++twrItr;
- }
- // If we get here we must be at the end of the list, or maybe the list is empty.
- if(!trafficList.size()) {
- t->nextOnRwy = true;
- // conflict and firstTime should be false and true respectively in this case anyway.
- } else {
- t->nextOnRwy = false;
- }
- trafficList.push_back(t);
- //cout << "\tE\t" << trafficList.size() << endl;
- return(holding ? firstTime : conflict);
-}
-
-// Add a tower plane rec with ETA to the circuit list in the correct position ETA-wise
-// Returns true if this might cause a separation conflict (based on ETA) with other traffic, false otherwise.
-// Safe to add a plane that is already in - planes with the same callsign are not added.
-bool FGTower::AddToCircuitList(TowerPlaneRec* t) {
- if(!t) {
- //cout << "**********************************************\n";
- //cout << "AddToCircuitList called with NULL pointer!!!!!\n";
- //cout << "**********************************************\n";
- return false;
- }
- //cout << "ADD: " << circuitList.size();
- //cout << ident << " AddToCircuitList called for " << t->plane.callsign << ", currently size = " << circuitList.size() << endl;
- double separation_time = 60.0; // seconds - this is currently a guess for light plane separation, and includes a few seconds for a holding plane to taxi onto the rwy.
- bool conflict = false;
- tower_plane_rec_list_iterator twrItr;
- // First check if the plane is already in the list
- //cout << "A" << endl;
- //cout << "Checking whether " << t->plane.callsign << " is already in circuit list..." << endl;
- //cout << "B" << endl;
- for(twrItr = circuitList.begin(); twrItr != circuitList.end(); twrItr++) {
- if((*twrItr)->plane.callsign == t->plane.callsign) {
- //cout << "In list - returning...\n";
- return false;
- }
- }
- //cout << "Not in list - adding..." << endl;
-
- for(twrItr = circuitList.begin(); twrItr != circuitList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- //cout << tpr->plane.callsign << " eta is " << tpr->eta << '\n';
- //cout << "New eta is " << t->eta << '\n';
- if(t->eta < tpr->eta) {
- // Ugg - this one's tricky.
- // It depends on what the two planes are doing and whether there's a conflict what we do.
- if(tpr->eta - t->eta > separation_time) { // No probs, plane 2 can squeeze in before plane 1 with no apparent conflict
- circuitList.insert(twrItr, t);
- circuitListItr = circuitList.begin();
- } else { // Ooops - this ones tricky - we have a potential conflict!
- conflict = true;
- // HACK - just add anyway for now and flag conflict.
- circuitList.insert(twrItr, t);
- circuitListItr = circuitList.begin();
- }
- //cout << "\tC\t" << circuitList.size() << '\n';
- return(conflict);
- }
- }
- // If we get here we must be at the end of the list, or maybe the list is empty.
- //cout << ident << " adding " << t->plane.callsign << " to circuitList" << endl;
- circuitList.push_back(t); // TODO - check the separation with the preceding plane for the conflict flag.
- circuitListItr = circuitList.begin();
- //cout << "\tE\t" << circuitList.size() << endl;
- return(conflict);
-}
-
-// Add to vacated list only if not already present
-void FGTower::AddToVacatedList(TowerPlaneRec* t) {
- tower_plane_rec_list_iterator twrItr;
- bool found = false;
- for(twrItr = vacatedList.begin(); twrItr != vacatedList.end(); twrItr++) {
- if((*twrItr)->plane.callsign == t->plane.callsign) {
- found = true;
- }
- }
- if(found) return;
- vacatedList.push_back(t);
-}
-
-void FGTower::AddToHoldingList(TowerPlaneRec* t) {
- tower_plane_rec_list_iterator it, end = holdList.end();
- for (it = holdList.begin(); it != end; ++it) {
- if ((*it)->plane.callsign == t->plane.callsign)
- return;
-
- holdList.push_back(t);
- }
-}
-
-// Calculate the eta of a plane to the threshold.
-// For ground traffic this is the fastest they can get there.
-// For air traffic this is the middle approximation.
-void FGTower::CalcETA(TowerPlaneRec* tpr, bool printout) {
- // For now we'll be very crude and hardwire expected speeds to C172-like values
- // The speeds below are specified in knots IAS and then converted to m/s
- double app_ias = 100.0 * 0.514444; // Speed during straight-in approach
- double circuit_ias = 80.0 * 0.514444; // Speed around circuit
- double final_ias = 70.0 * 0.514444; // Speed during final approach
-
- //if(printout) {
- //cout << "In CalcETA, airplane ident = " << tpr->plane.callsign << '\n';
- //cout << (tpr->isUser ? "USER\n" : "AI\n");
- //cout << flush;
- //}
-
- // Sign convention - dist_out is -ve for approaching planes and +ve for departing planes
- // dist_across is +ve in the pattern direction - ie a plane correctly on downwind will have a +ve dist_across
-
- Point3D op = ortho.ConvertToLocal(tpr->pos);
- //if(printout) {
- //if(!tpr->isUser) cout << "Orthopos is " << op.x() << ", " << op.y() << ' ';
- //cout << "opType is " << tpr->opType << '\n';
- //}
- double dist_out_m = op.y();
- double dist_across_m = fabs(op.x()); // The fabs is a hack to cope with the fact that we don't know the circuit direction yet
- //cout << "Doing ETA calc for " << tpr->plane.callsign << '\n';
-
- if(tpr->opType == STRAIGHT_IN || tpr->opType == INBOUND) {
- //cout << "CASE 1\n";
- double dist_to_go_m = sqrt((dist_out_m * dist_out_m) + (dist_across_m * dist_across_m));
- if(dist_to_go_m < 1000) {
- tpr->eta = dist_to_go_m / final_ias;
- } else {
- tpr->eta = (1000.0 / final_ias) + ((dist_to_go_m - 1000.0) / app_ias);
- }
- } else if(tpr->opType == CIRCUIT || tpr->opType == TTT_UNKNOWN) { // Hack alert - UNKNOWN has sort of been added here as a temporary hack.
- //cout << "CASE 2\n";
- // It's complicated - depends on if base leg is delayed or not
- //if(printout) {
- //cout << "Leg = " << tpr->leg << '\n';
- //}
- if(tpr->leg == LANDING_ROLL) {
- tpr->eta = 0;
- } else if((tpr->leg == FINAL) || (tpr->leg == TURN4)) {
- //cout << "dist_out_m = " << dist_out_m << '\n';
- tpr->eta = fabs(dist_out_m) / final_ias;
- } else if((tpr->leg == BASE) || (tpr->leg == TURN3)) {
- tpr->eta = (fabs(dist_out_m) / final_ias) + (dist_across_m / circuit_ias);
- } else {
- // Need to calculate where base leg is likely to be
- // FIXME - for now I'll hardwire it to 1000m which is what AILocalTraffic uses!!!
- // TODO - as a matter of design - AILocalTraffic should get the nominal no-traffic base turn distance from Tower, since in real life the published pattern might differ from airport to airport
- double nominal_base_dist_out_m = -1000;
- double current_base_dist_out_m;
- if(!GetBaseConstraint(current_base_dist_out_m)) {
- current_base_dist_out_m = nominal_base_dist_out_m;
- }
- //cout << "current_base_dist_out_m = " << current_base_dist_out_m << '\n';
- double nominal_dist_across_m = 1000; // Hardwired value from AILocalTraffic
- double current_dist_across_m;
- if(!GetDownwindConstraint(current_dist_across_m)) {
- current_dist_across_m = nominal_dist_across_m;
- }
- double nominal_cross_dist_out_m = 2000; // Bit of a guess - AI plane turns to crosswind at 700ft agl.
- tpr->eta = fabs(current_base_dist_out_m) / final_ias; // final
- //cout << "a = " << tpr->eta << '\n';
- if((tpr->leg == DOWNWIND) || (tpr->leg == TURN2)) {
- tpr->eta += dist_across_m / circuit_ias;
- //cout << "b = " << tpr->eta << '\n';
- tpr->eta += fabs(current_base_dist_out_m - dist_out_m) / circuit_ias;
- //cout << "c = " << tpr->eta << '\n';
- } else if((tpr->leg == CROSSWIND) || (tpr->leg == TURN1)) {
- //cout << "CROSSWIND calc: ";
- //cout << tpr->eta << ' ';
- if(dist_across_m > nominal_dist_across_m) {
- tpr->eta += dist_across_m / circuit_ias;
- //cout << "a ";
- } else {
- tpr->eta += nominal_dist_across_m / circuit_ias;
- //cout << "b ";
- }
- //cout << tpr->eta << ' ';
- // should we use the dist across of the previous plane if there is previous still on downwind?
- //if(printout) cout << "bb = " << tpr->eta << '\n';
- if(dist_out_m > nominal_cross_dist_out_m) {
- tpr->eta += fabs(current_base_dist_out_m - dist_out_m) / circuit_ias;
- //cout << "c ";
- } else {
- tpr->eta += fabs(current_base_dist_out_m - nominal_cross_dist_out_m) / circuit_ias;
- //cout << "d ";
- }
- //cout << tpr->eta << ' ';
- //if(printout) cout << "cc = " << tpr->eta << '\n';
- if(nominal_dist_across_m > dist_across_m) {
- tpr->eta += (nominal_dist_across_m - dist_across_m) / circuit_ias;
- //cout << "e ";
- } else {
- // Nothing to add
- //cout << "f ";
- }
- //cout << tpr->eta << '\n';
- //if(printout) cout << "dd = " << tpr->eta << '\n';
- } else {
- // We've only just started - why not use a generic estimate?
- tpr->eta = 240.0;
- }
- }
- //if(printout) {
- // cout << "ETA = " << tpr->eta << '\n';
- //}
- //if(!tpr->isUser) cout << tpr->plane.callsign << '\t' << tpr->eta << '\n';
- } else {
- tpr->eta = 99999;
- }
-}
-
-
-// Calculate the distance of a plane to the threshold in meters
-// TODO - Modify to calculate flying distance of a plane in the circuit
-double FGTower::CalcDistOutM(TowerPlaneRec* tpr) {
- return(dclGetHorizontalSeparation(rwy.threshold_pos, tpr->pos));
-}
-
-
-// Calculate the distance of a plane to the threshold in miles
-// TODO - Modify to calculate flying distance of a plane in the circuit
-double FGTower::CalcDistOutMiles(TowerPlaneRec* tpr) {
- return(CalcDistOutM(tpr) / 1600.0); // FIXME - use a proper constant if possible.
-}
-
-
-// Iterate through all the lists, update the position of, and call CalcETA for all the planes.
-void FGTower::doThresholdETACalc() {
- //cout << "Entering doThresholdETACalc..." << endl;
- tower_plane_rec_list_iterator twrItr;
- // Do the approach list first
- for(twrItr = appList.begin(); twrItr != appList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- if(!(tpr->isUser)) tpr->pos = tpr->planePtr->GetPos();
- //cout << "APP: ";
- CalcETA(tpr);
- }
- // Then the circuit list
- //cout << "Circuit list size is " << circuitList.size() << '\n';
- for(twrItr = circuitList.begin(); twrItr != circuitList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- if(!(tpr->isUser)) tpr->pos = tpr->planePtr->GetPos();
- //cout << "CIRC: ";
- CalcETA(tpr);
- }
- //cout << "Done doThresholdETCCalc" << endl;
-}
-
-
-// Check that the planes in traffic list are correctly ordered,
-// that the nearest (timewise) is flagged next on rwy, and return
-// true if any threshold use conflicts are detected, false otherwise.
-bool FGTower::doThresholdUseOrder() {
- //cout << "Entering doThresholdUseOrder..." << endl;
- bool conflict = false;
-
- // Wipe out traffic list, go through circuit, app and hold list, and reorder them in traffic list.
- // Here's the rather simplistic assumptions we're using:
- // Currently all planes are assumed to be GA light singles with corresponding speeds and separation times.
- // In order of priority for runway use:
- // STRAIGHT_IN > CIRCUIT > HOLDING_FOR_DEPARTURE
- // No modification of planes speeds occurs - conflicts are resolved by delaying turn for base,
- // and holding planes until a space.
- // When calculating if a holding plane can use the runway, time clearance from last departure
- // as well as time clearance to next arrival must be considered.
-
- trafficList.clear();
-
- tower_plane_rec_list_iterator twrItr;
- // Do the approach list first
- //if(ident == "KRHV") cout << "A" << flush;
- for(twrItr = appList.begin(); twrItr != appList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- //if(ident == "KRHV") cout << tpr->plane.callsign << '\n';
- conflict = AddToTrafficList(tpr);
- }
- // Then the circuit list
- //if(ident == "KRHV") cout << "C" << flush;
- for(twrItr = circuitList.begin(); twrItr != circuitList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- //if(ident == "KRHV") cout << tpr->plane.callsign << '\n';
- conflict = AddToTrafficList(tpr);
- }
- // And finally the hold list
- //cout << "H" << endl;
- for(twrItr = holdList.begin(); twrItr != holdList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- AddToTrafficList(tpr, true);
- }
-
-
- if(0) {
- //if(ident == "KRHV") {
- cout << "T\n";
- for(twrItr = trafficList.begin(); twrItr != trafficList.end(); twrItr++) {
- TowerPlaneRec* tpr = *twrItr;
- cout << tpr->plane.callsign << '\t' << tpr->eta << '\t';
- }
- cout << endl;
- }
-
- //cout << "Done doThresholdUseOrder" << endl;
- return(conflict);
-}
-
-
-// Return the ETA of plane no. list_pos (1-based) in the traffic list.
-// i.e. list_pos = 1 implies next to use runway.
-double FGTower::GetTrafficETA(unsigned int list_pos, bool printout) {
- if(trafficList.size() < list_pos) {
- return(99999);
- }
-
- tower_plane_rec_list_iterator twrItr;
- twrItr = trafficList.begin();
- for(unsigned int i = 1; i < list_pos; i++, twrItr++);
- TowerPlaneRec* tpr = *twrItr;
- CalcETA(tpr, printout);
- //cout << "ETA returned = " << tpr->eta << '\n';
- return(tpr->eta);
-}
-
-
-void FGTower::ContactAtHoldShort(const PlaneRec& plane, FGAIPlane* requestee, tower_traffic_type operation) {
- // HACK - assume that anything contacting at hold short is new for now - FIXME LATER
- TowerPlaneRec* t = new TowerPlaneRec;
- t->plane = plane;
- t->planePtr = requestee;
- t->holdShortReported = true;
- t->clearedToLineUp = false;
- t->clearedToTakeOff = false;
- t->opType = operation;
- t->pos = requestee->GetPos();
-
- //cout << "Hold Short reported by " << plane.callsign << '\n';
- SG_LOG(SG_ATC, SG_BULK, "Hold Short reported by " << plane.callsign);
-
-/*
- bool next = AddToTrafficList(t, true);
- if(next) {
- double teta = GetTrafficETA(2);
- if(teta < 150.0) {
- t->clearanceCounter = 7.0; // This reduces the delay before response to 3 secs if an immediate takeoff is reqd
- //cout << "Reducing response time to request due imminent traffic\n";
- }
- } else {
- }
-*/
- // TODO - possibly add the reduced interval to clearance when immediate back in under the new scheme
-
- holdList.push_back(t);
-
- responseReqd = true;
-}
-
-// Register the presence of an AI plane at a point where contact would already have been made in real life
-// CAUTION - currently it is assumed that this plane's callsign is unique - it is up to AIMgr to generate unique callsigns.
-void FGTower::RegisterAIPlane(const PlaneRec& plane, FGAIPlane* ai, const tower_traffic_type& op, const PatternLeg& lg) {
- // At the moment this is only going to be tested with inserting an AI plane on downwind
- TowerPlaneRec* t = new TowerPlaneRec;
- t->plane = plane;
- t->planePtr = ai;
- t->opType = op;
- t->leg = lg;
- t->pos = ai->GetPos();
-
- CalcETA(t);
-
- if(op == CIRCUIT && lg != LEG_UNKNOWN) {
- AddToCircuitList(t);
- } else {
- // FLAG A WARNING
- }
-
- doThresholdUseOrder();
-}
-
-void FGTower::DeregisterAIPlane(const string& id) {
- RemovePlane(id);
-}
-
-// Contact tower for VFR approach
-// eg "Cessna Charlie Foxtrot Golf Foxtrot Sierra eight miles South of the airport for full stop with Bravo"
-// This function probably only called via user interaction - AI planes will have an overloaded function taking a planerec.
-// opt defaults to AIP_LT_UNKNOWN
-void FGTower::VFRArrivalContact(const string& ID, const LandingType& opt) {
- //cout << "USER Request Landing Clearance called for ID " << ID << '\n';
-
- // For now we'll assume that the user is a light plane and can get him/her to join the circuit if necessary.
-
- TowerPlaneRec* t;
- string usercall = fgGetString("/sim/user/callsign");
- if(ID == "USER" || ID == usercall) {
- t = FindPlane(usercall);
- if(!t) {
- //cout << "NOT t\n";
- t = new TowerPlaneRec;
- t->isUser = true;
- t->pos.setlon(user_lon_node->getDoubleValue());
- t->pos.setlat(user_lat_node->getDoubleValue());
- t->pos.setelev(user_elev_node->getDoubleValue());
- } else {
- //cout << "IS t\n";
- // Oops - the plane is already registered with this tower - maybe we took off and flew a giant circuit without
- // quite getting out of tower airspace - just ignore for now and treat as new arrival.
- // TODO - Maybe should remove from departure and circuit list if in there though!!
- }
- } else {
- // Oops - something has gone wrong - put out a warning
- cout << "WARNING - FGTower::VFRContact(string ID, LandingType lt) called with ID " << ID << " which does not appear to be the user.\n";
- return;
- }
-
-
- // TODO
- // Calculate where the plane is in relation to the active runway and it's circuit
- // and set the op-type as appropriate.
-
- // HACK - to get up and running I'm going to assume that the user contacts tower on a staight-in final for now.
- t->opType = STRAIGHT_IN;
-
- t->plane.type = GA_SINGLE; // FIXME - Another assumption!
- t->plane.callsign = usercall;
-
- t->vfrArrivalReported = true;
- responseReqd = true;
-
- appList.push_back(t); // Not necessarily permanent
- appListItr = appList.begin();
- AddToTrafficList(t);
-
- current_atcdialog->remove_entry(ident, USER_REQUEST_VFR_ARRIVAL, TOWER);
- current_atcdialog->remove_entry(ident, USER_REQUEST_VFR_ARRIVAL_FULL_STOP, TOWER);
- current_atcdialog->remove_entry(ident, USER_REQUEST_VFR_ARRIVAL_TOUCH_AND_GO, TOWER);
-}
-
-// landingType defaults to AIP_LT_UNKNOWN
-void FGTower::VFRArrivalContact(const PlaneRec& plane, FGAIPlane* requestee, const LandingType& lt) {
- //cout << "VFRArrivalContact called for plane " << plane.callsign << " at " << ident << '\n';
- // Possible hack - assume this plane is new for now - TODO - should check really
- TowerPlaneRec* t = new TowerPlaneRec;
- t->plane = plane;
- t->planePtr = requestee;
- t->landingType = lt;
- t->pos = requestee->GetPos();
-
- //cout << "Hold Short reported by " << plane.callsign << '\n';
- SG_LOG(SG_ATC, SG_BULK, "VFR arrival contact made by " << plane.callsign);
- //cout << "VFR arrival contact made by " << plane.callsign << '\n';
-
- // HACK - to get up and running I'm going to assume a staight-in final for now.
- t->opType = STRAIGHT_IN;
-
- t->vfrArrivalReported = true;
- responseReqd = true;
-
- //cout << "Before adding, appList.size = " << appList.size() << " at " << ident << '\n';
- appList.push_back(t); // Not necessarily permanent
- appListItr = appList.begin();
- //cout << "After adding, appList.size = " << appList.size() << " at " << ident << '\n';
- AddToTrafficList(t);
-}
-
-void FGTower::RequestDepartureClearance(const string& ID) {
- //cout << "Request Departure Clearance called...\n";
-}
-
-void FGTower::RequestTakeOffClearance(const string& ID) {
- string uid=ID;
- if(ID == "USER") {
- uid = fgGetString("/sim/user/callsign");
- current_atcdialog->remove_entry(ident, USER_REQUEST_TAKE_OFF, TOWER);
- }
- TowerPlaneRec* t = FindPlane(uid);
- if(t) {
- if(!(t->clearedToTakeOff)) {
- departed = false;
- t->lineUpReported=true;
- responseReqd = true;
- }
- }
- else {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Unable to find plane " << ID << " in FGTower::RequestTakeOffClearance(...)");
- }
-}
-
-void FGTower::ReportFinal(const string& ID) {
- //cout << "Report Final Called at tower " << ident << " by plane " << ID << '\n';
- string uid=ID;
- if(ID == "USER") {
- uid = fgGetString("/sim/user/callsign");
- current_atcdialog->remove_entry(ident, USER_REPORT_3_MILE_FINAL, TOWER);
- }
- TowerPlaneRec* t = FindPlane(uid);
- if(t) {
- t->finalReported = true;
- t->finalAcknowledged = false;
- if(!(t->clearedToLand)) {
- responseReqd = true;
- } else {
- // possibly respond with wind even if already cleared to land?
- t->finalReported = false;
- t->finalAcknowledged = true;
- // HACK!! - prevents next reporting being misinterpreted as this one.
- }
- } else {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Unable to find plane " << ID << " in FGTower::ReportFinal(...)");
- }
-}
-
-void FGTower::ReportLongFinal(const string& ID) {
- string uid=ID;
- if(ID == "USER") {
- uid = fgGetString("/sim/user/callsign");
- current_atcdialog->remove_entry(ident, USER_REPORT_3_MILE_FINAL, TOWER);
- }
- TowerPlaneRec* t = FindPlane(uid);
- if(t) {
- t->longFinalReported = true;
- t->longFinalAcknowledged = false;
- if(!(t->clearedToLand)) {
- responseReqd = true;
- } // possibly respond with wind even if already cleared to land?
- } else {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Unable to find plane " << ID << " in FGTower::ReportLongFinal(...)");
- }
-}
-
-//void FGTower::ReportOuterMarker(string ID);
-//void FGTower::ReportMiddleMarker(string ID);
-//void FGTower::ReportInnerMarker(string ID);
-
-void FGTower::ReportRunwayVacated(const string& ID) {
- //cout << "Report Runway Vacated Called at tower " << ident << " by plane " << ID << '\n';
- string uid=ID;
- if(ID == "USER") {
- uid = fgGetString("/sim/user/callsign");
- current_atcdialog->remove_entry(ident, USER_REPORT_RWY_VACATED, TOWER);
- }
- TowerPlaneRec* t = FindPlane(uid);
- if(t) {
- //cout << "Found it...\n";
- t->rwyVacatedReported = true;
- responseReqd = true;
- } else {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Unable to find plane " << ID << " in FGTower::ReportRunwayVacated(...)");
- SG_LOG(SG_ATC, SG_ALERT, "A WARNING: Unable to find plane " << ID << " in FGTower::ReportRunwayVacated(...)");
- //cout << "WARNING: Unable to find plane " << ID << " in FGTower::ReportRunwayVacated(...)\n";
- }
-}
-
-TowerPlaneRec* FGTower::FindPlane(const string& ID) {
- //cout << "FindPlane called for " << ID << "...\n";
- tower_plane_rec_list_iterator twrItr;
- // Do the approach list first
- for(twrItr = appList.begin(); twrItr != appList.end(); twrItr++) {
- //cout << "appList callsign is " << (*twrItr)->plane.callsign << '\n';
- if((*twrItr)->plane.callsign == ID) return(*twrItr);
- }
- // Then the circuit list
- for(twrItr = circuitList.begin(); twrItr != circuitList.end(); twrItr++) {
- //cout << "circuitList callsign is " << (*twrItr)->plane.callsign << '\n';
- if((*twrItr)->plane.callsign == ID) return(*twrItr);
- }
- // Then the runway list
- //cout << "rwyList.size() is " << rwyList.size() << '\n';
- for(twrItr = rwyList.begin(); twrItr != rwyList.end(); twrItr++) {
- //cout << "rwyList callsign is " << (*twrItr)->plane.callsign << '\n';
- if((*twrItr)->plane.callsign == ID) return(*twrItr);
- }
- // The hold list
- for(twrItr = holdList.begin(); twrItr != holdList.end(); twrItr++) {
- if((*twrItr)->plane.callsign == ID) return(*twrItr);
- }
- // And finally the vacated list
- for(twrItr = vacatedList.begin(); twrItr != vacatedList.end(); twrItr++) {
- //cout << "vacatedList callsign is " << (*twrItr)->plane.callsign << '\n';
- if((*twrItr)->plane.callsign == ID) return(*twrItr);
- }
- SG_LOG(SG_ATC, SG_WARN, "Unable to find " << ID << " in FGTower::FindPlane(...)");
- //exit(-1);
- return(NULL);
-}
-
-void FGTower::RemovePlane(const string& ID) {
- //cout << ident << " RemovePlane called for " << ID << '\n';
- // We have to be careful here - we want to erase the plane from all lists it is in,
- // but we can only delete it once, AT THE END.
- TowerPlaneRec* t = NULL;
- tower_plane_rec_list_iterator twrItr;
- for(twrItr = appList.begin(); twrItr != appList.end();) {
- if((*twrItr)->plane.callsign == ID) {
- t = *twrItr;
- twrItr = appList.erase(twrItr);
- appListItr = appList.begin();
- // HACK: aircraft are sometimes more than once in a list, so we need to
- // remove them all before we can delete the TowerPlaneRec class
- //break;
- } else
- ++twrItr;
- }
- for(twrItr = depList.begin(); twrItr != depList.end();) {
- if((*twrItr)->plane.callsign == ID) {
- t = *twrItr;
- twrItr = depList.erase(twrItr);
- depListItr = depList.begin();
- } else
- ++twrItr;
- }
- for(twrItr = circuitList.begin(); twrItr != circuitList.end();) {
- if((*twrItr)->plane.callsign == ID) {
- t = *twrItr;
- twrItr = circuitList.erase(twrItr);
- circuitListItr = circuitList.begin();
- } else
- ++twrItr;
- }
- for(twrItr = holdList.begin(); twrItr != holdList.end();) {
- if((*twrItr)->plane.callsign == ID) {
- t = *twrItr;
- twrItr = holdList.erase(twrItr);
- holdListItr = holdList.begin();
- } else
- ++twrItr;
- }
- for(twrItr = rwyList.begin(); twrItr != rwyList.end();) {
- if((*twrItr)->plane.callsign == ID) {
- t = *twrItr;
- twrItr = rwyList.erase(twrItr);
- rwyListItr = rwyList.begin();
- } else
- ++twrItr;
- }
- for(twrItr = vacatedList.begin(); twrItr != vacatedList.end();) {
- if((*twrItr)->plane.callsign == ID) {
- t = *twrItr;
- twrItr = vacatedList.erase(twrItr);
- vacatedListItr = vacatedList.begin();
- } else
- ++twrItr;
- }
- for(twrItr = trafficList.begin(); twrItr != trafficList.end();) {
- if((*twrItr)->plane.callsign == ID) {
- t = *twrItr;
- twrItr = trafficList.erase(twrItr);
- trafficListItr = trafficList.begin();
- } else
- ++twrItr;
- }
- // And finally, delete the record.
- delete t;
-}
-
-void FGTower::ReportDownwind(const string& ID) {
- //cout << "ReportDownwind(...) called\n";
- string uid=ID;
- if(ID == "USER") {
- uid = fgGetString("/sim/user/callsign");
- current_atcdialog->remove_entry(ident, USER_REPORT_DOWNWIND, TOWER);
- }
- TowerPlaneRec* t = FindPlane(uid);
- if(t) {
- t->downwindReported = true;
- responseReqd = true;
- // If the plane is in the app list, remove it and put it in the circuit list instead.
- // Ideally we might want to do this at the 2 mile report prior to 45 deg entry, but at
- // the moment that would b&gg?r up the constraint position calculations.
- RemoveFromAppList(ID);
- t->leg = DOWNWIND;
- if(t->isUser) {
- t->pos.setlon(user_lon_node->getDoubleValue());
- t->pos.setlat(user_lat_node->getDoubleValue());
- t->pos.setelev(user_elev_node->getDoubleValue());
- } else {
- // ASSERT(t->planePtr != NULL);
- t->pos = t->planePtr->GetPos();
- }
- CalcETA(t);
- AddToCircuitList(t);
- } else {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Unable to find plane " << ID << " in FGTower::ReportDownwind(...)");
- }
-}
-
-void FGTower::ReportGoingAround(const string& ID) {
- string uid=ID;
- if(ID == "USER") {
- uid = fgGetString("/sim/user/callsign");
- RemoveAllUserDialogOptions(); // TODO - it would be much more efficient if ATCDialog simply had a clear() function!!!
- current_atcdialog->add_entry(ident, "@AP Tower, @CS Downwind @RW", "Report Downwind", TOWER, (int)USER_REPORT_DOWNWIND);
- }
- TowerPlaneRec* t = FindPlane(uid);
- if(t) {
- //t->goAroundReported = true; // No need to set this until we start responding to it.
- responseReqd = false; // might change in the future but for now we'll not distract them during the go-around.
- // If the plane is in the app list, remove it and put it in the circuit list instead.
- RemoveFromAppList(ID);
- t->leg = CLIMBOUT;
- if(t->isUser) {
- t->pos.setlon(user_lon_node->getDoubleValue());
- t->pos.setlat(user_lat_node->getDoubleValue());
- t->pos.setelev(user_elev_node->getDoubleValue());
- } else {
- // ASSERT(t->planePtr != NULL);
- t->pos = t->planePtr->GetPos();
- }
- CalcETA(t);
- AddToCircuitList(t);
- } else {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Unable to find plane " << ID << " in FGTower::ReportDownwind(...)");
- }
-}
-
-string FGTower::GenText(const string& m, int c) {
- 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;
- string usercall = fgGetString("/sim/user/callsign");
- TowerPlaneRec* t = FindPlane(responseID);
-
- //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], m.c_str() );
-
- // Replace all the '@' parameters with the actual text.
- int check = 0; // If mes gets overflowed the while loop can go infinite
- double gp = fgGetFloat("/gear/gear/position-norm");
- 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() );
- strcat(&dum[0], ident.c_str());
- else if ( strcmp ( tag, "@AP" ) == 0 )
- //strcat( &dum[0], tpars.airport.c_str() );
- strcat(&dum[0], name.c_str());
- else if ( strcmp ( tag, "@CS" ) == 0 )
- //strcat( &dum[0], tpars.callsign.c_str() );
- strcat(&dum[0], usercall.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, "@AT" ) == 0 ) { // ATIS ID
- /*
- char buf[10];
- sprintf( buf, "%i", (int)(tpars.heading) );
- strcat( &dum[0], &buf[0] );
- */
- double f = globals->get_ATC_mgr()->GetFrequency(ident, ATIS) / 100.0;
- if(f) {
- string atis_id;
- atis_id = ", information " + GetATISID();
- strcat( &dum[0], atis_id.c_str() );
- }
- }
- 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, "@TO" ) == 0 ) { // Requesting take-off or departure clearance
- string tmp;
- if (rwyOccupied) {
- tmp = "Ready for take-off";
- } else {
- if (OnAnyRunway(Point3D(user_lon_node->getDoubleValue(),
- user_lat_node->getDoubleValue(), 0.0),true)) {
- tmp = "Request take-off clearance";
- } else {
- tmp = "Request departure clearance";
- }
- }
- strcat(&dum[0], tmp.c_str());
- }
- else if ( strcmp ( tag, "@MI" ) == 0 ) {
- char buf[10];
- //sprintf( buf, "%3.1f", tpars.miles );
- int dist_miles = (int)dclGetHorizontalSeparation(Point3D(lon, lat, elev), Point3D(user_lon_node->getDoubleValue(), user_lat_node->getDoubleValue(), user_elev_node->getDoubleValue())) / 1600;
- sprintf(buf, "%i", dist_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], ConvertRwyNumToSpokenString(activeRwy).c_str());
- }
- else if ( strcmp ( tag, "@GR" ) == 0 ) { // Gear position (on final)
- if(t->gearWasUp && gp > 0.99) {
- strcat(&dum[0], ", gear down, ready to land.");
- }
- }
- else if(strcmp(tag, "@CD") == 0) { // @CD = compass direction
- double h = GetHeadingFromTo(Point3D(lon, lat, elev), Point3D(user_lon_node->getDoubleValue(), user_lat_node->getDoubleValue(), user_elev_node->getDoubleValue()));
- while(h < 0.0) h += 360.0;
- while(h > 360.0) h -= 360.0;
- if(h < 22.5 || h > 337.5) {
- strcat(&dum[0], "North");
- } else if(h < 67.5) {
- strcat(&dum[0], "North-East");
- } else if(h < 112.5) {
- strcat(&dum[0], "East");
- } else if(h < 157.5) {
- strcat(&dum[0], "South-East");
- } else if(h < 202.5) {
- strcat(&dum[0], "South");
- } else if(h < 247.5) {
- strcat(&dum[0], "South-West");
- } else if(h < 292.5) {
- strcat(&dum[0], "West");
- } else {
- strcat(&dum[0], "North-West");
- }
- } else {
- cout << "Tag " << tag << " not found" << endl;
- break;
- }
- strcat( &dum[0], &mes[len+3] );
- strcpy( &mes[0], &dum[0] );
-
- ++check;
- if(check > 10) {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Possibly endless loop terminated in FGTransmissionlist::gen_text(...)");
- break;
- }
- }
-
- //cout << mes << endl;
- //break;
- //}
- //}
- return mes[0] ? mes : "No transmission found";
-}
-
-string FGTower::GetWeather() {
- std::ostringstream msg;
-
- // wind
- double hdg = wind_from_hdg->getDoubleValue();
- double speed = wind_speed_knots->getDoubleValue();
- if (speed < 1)
- msg << "wind calm";
- else
- msg << "wind " << int(hdg) << " degrees at " << int(speed) << " knots";
-
- // visibility
- double visibility = fgGetDouble("/environment/visibility-m");
- if (visibility < 10000)
- msg << ", visibility " << int(visibility / 1609) << " miles";
-
- // pressure / altimeter
- double pressure = fgGetDouble("/environment/pressure-sea-level-inhg");
- msg << ", QFE " << fixed << setprecision(2) << pressure << ".";
-
- return msg.str();
-}
-
-string FGTower::GetATISID() {
- int hours = fgGetInt("/sim/time/utc/hour");
- int phonetic_id = current_commlist->GetCallSign(ident, hours, 0);
- return GetPhoneticIdent(phonetic_id);
-}
-
-ostream& operator << (ostream& os, tower_traffic_type ttt) {
- switch(ttt) {
- case(CIRCUIT): return(os << "CIRCUIT");
- case(INBOUND): return(os << "INBOUND");
- case(OUTBOUND): return(os << "OUTBOUND");
- case(TTT_UNKNOWN): return(os << "UNKNOWN");
- case(STRAIGHT_IN): return(os << "STRAIGHT_IN");
- }
- return(os << "ERROR - Unknown switch in tower_traffic_type operator << ");
-}
-
+++ /dev/null
-// FGTower - a class to provide tower control at towered airports.
-//
-// Written 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.
-
-#ifndef _FG_TOWER_HXX
-#define _FG_TOWER_HXX
-
-#include <simgear/compiler.h>
-#include <simgear/math/point3d.hxx>
-#include <simgear/misc/sgstream.hxx>
-#include <plib/sg.h>
-
-#include STL_IOSTREAM
-#include STL_STRING
-
-SG_USING_STD(string);
-SG_USING_STD(ios);
-
-#include "ATC.hxx"
-#include "ATCProjection.hxx"
-#include "AIPlane.hxx"
-
-class FGATCMgr;
-class FGGround;
-
-//DCL - a complete guess for now.
-#define FG_TOWER_DEFAULT_RANGE 30
-
-enum tower_traffic_type {
- CIRCUIT,
- INBOUND, // CIRCUIT traffic gets changed to INBOUND when on final of the full-stop circuit.
- OUTBOUND,
- TTT_UNKNOWN, // departure, but we don't know if for circuits or leaving properly
- STRAIGHT_IN
-};
-
-ostream& operator << (ostream& os, tower_traffic_type ttt);
-
-enum tower_callback_type {
- USER_REQUEST_VFR_DEPARTURE = 1,
- USER_REQUEST_VFR_ARRIVAL = 2,
- USER_REQUEST_VFR_ARRIVAL_FULL_STOP = 3,
- USER_REQUEST_VFR_ARRIVAL_TOUCH_AND_GO = 4,
- USER_REPORT_3_MILE_FINAL = 5,
- USER_REPORT_DOWNWIND = 6,
- USER_REPORT_RWY_VACATED = 7,
- USER_REPORT_GOING_AROUND = 8,
- USER_REQUEST_TAKE_OFF = 9
-};
-
-// TODO - need some differentiation of IFR and VFR traffic in order to give the former priority.
-
-// Structure for holding details of a plane under tower control.
-// Not fixed yet - may include more stuff later.
-class TowerPlaneRec {
-
-public:
-
- TowerPlaneRec();
- TowerPlaneRec(const PlaneRec& p);
- TowerPlaneRec(const Point3D& pt);
- TowerPlaneRec(const PlaneRec& p, const Point3D& pt);
-
- FGAIPlane* planePtr; // This might move to the planeRec eventually
- PlaneRec plane;
-
- Point3D pos;
- double eta; // seconds
- double dist_out; // meters from theshold
- bool clearedToLand;
- bool clearedToLineUp;
- bool clearedToTakeOff;
- // ought to add time cleared to depart so we can nag if necessary
- bool holdShortReported;
- bool lineUpReported;
- bool downwindReported;
- bool longFinalReported;
- bool longFinalAcknowledged;
- bool finalReported;
- bool finalAcknowledged;
- bool rwyVacatedReported;
- bool rwyVacatedAcknowledged;
- bool goAroundReported; // set true if plane informs tower that it's going around.
- bool instructedToGoAround; // set true if plane told by tower to go around.
- bool onRwy; // is physically on the runway
- bool nextOnRwy; // currently projected by tower to be the next on the runway
- bool gearWasUp; // Tell to ATC about gear
- bool gearUpReported; // Tell to pilot about landing gear
-
- bool vfrArrivalReported;
- bool vfrArrivalAcknowledged;
-
- // Type of operation the plane is doing
- tower_traffic_type opType;
-
- // Whereabouts in circuit if doing circuits
- PatternLeg leg;
-
- LandingType landingType;
- bool isUser; // true if this plane is the user
-};
-
-
-typedef list < TowerPlaneRec* > tower_plane_rec_list_type;
-typedef tower_plane_rec_list_type::iterator tower_plane_rec_list_iterator;
-typedef tower_plane_rec_list_type::const_iterator tower_plane_rec_list_const_iterator;
-
-
-class FGTower : public FGATC {
-
-public:
-
- FGTower();
- ~FGTower();
-
- void Init();
-
- void Update(double dt);
-
- void ReceiveUserCallback(int code);
-
- // Contact tower for VFR approach
- // eg "Cessna Charlie Foxtrot Golf Foxtrot Sierra eight miles South of the airport for full stop with Bravo"
- // This function probably only called via user interaction - AI planes will have an overloaded function taking a planerec.
- void VFRArrivalContact(const string& ID, const LandingType& opt = AIP_LT_UNKNOWN);
- // For the AI planes...
- void VFRArrivalContact(const PlaneRec& plane, FGAIPlane* requestee, const LandingType& lt = AIP_LT_UNKNOWN);
-
- void RequestDepartureClearance(const string& ID);
- void RequestTakeOffClearance(const string& ID);
- void ReportFinal(const string& ID);
- void ReportLongFinal(const string& ID);
- void ReportOuterMarker(const string& ID);
- void ReportMiddleMarker(const string& ID);
- void ReportInnerMarker(const string& ID);
- void ReportRunwayVacated(const string& ID);
- void ReportReadyForDeparture(const string& ID);
- void ReportDownwind(const string& ID);
- void ReportGoingAround(const string& ID);
-
- // Contact tower when at a hold short for departure - for now we'll assume plane - maybe vehicles might want to cross runway eventually?
- void ContactAtHoldShort(const PlaneRec& plane, FGAIPlane* requestee, tower_traffic_type operation);
-
- // Register the presence of an AI plane at a point where contact would already have been made in real life
- // CAUTION - currently it is assumed that this plane's callsign is unique - it is up to AIMgr to generate unique callsigns.
- void RegisterAIPlane(const PlaneRec& plane, FGAIPlane* ai, const tower_traffic_type& op, const PatternLeg& lg = LEG_UNKNOWN);
-
- // Deregister and remove an AI plane.
- void DeregisterAIPlane(const string& id);
-
- // Public interface to the active runway - this will get more complex
- // in the future and consider multi-runway use, airplane weight etc.
- inline const string& GetActiveRunway() const { return activeRwy; }
- inline const RunwayDetails& GetActiveRunwayDetails() const { return rwy; }
- // Get the pattern direction of the active rwy.
- inline int GetPatternDirection() const { return rwy.patternDirection; }
-
- inline const string& get_trans_ident() const { return trans_ident; }
-
- inline FGGround* const GetGroundPtr() const { return ground; }
-
- // Returns true if positions of crosswind/downwind/base leg turns should be constrained by previous traffic
- // plus the constraint position as a rwy orientated orthopos (meters)
- bool GetCrosswindConstraint(double& cpos);
- bool GetDownwindConstraint(double& dpos);
- bool GetBaseConstraint(double& bpos);
-
- string GenText(const string& m, int c);
- string GetWeather();
- string GetATISID();
-
-private:
- FGATCMgr* ATCmgr;
- // This is purely for synactic convienience to avoid writing globals->get_ATC_mgr()-> all through the code!
-
- // Respond to a transmission
- void Respond();
-
- void ProcessRunwayVacatedReport(TowerPlaneRec* t);
- void ProcessDownwindReport(TowerPlaneRec* t);
-
- // Remove all options from the user dialog choice
- void RemoveAllUserDialogOptions();
-
- // Periodic checks on the various traffic.
- void CheckHoldList(double dt);
- void CheckCircuitList(double dt);
- void CheckRunwayList(double dt);
- void CheckApproachList(double dt);
- void CheckDepartureList(double dt);
-
- // Currently this assumes we *are* next on the runway and doesn't check for planes about to land -
- // this should be done prior to calling this function.
- void ClearHoldingPlane(TowerPlaneRec* t);
-
- // Find a pointer to plane of callsign ID within the internal data structures
- TowerPlaneRec* FindPlane(const string& ID);
-
- // Remove and delete all instances of a plane with a given ID
- void RemovePlane(const string& ID);
-
- // Figure out if a given position lies on the active runway
- // Might have to change when we consider more than one active rwy.
- bool OnActiveRunway(const Point3D& pt);
-
- // Figure out if a given position lies on a runway or not
- bool OnAnyRunway(const Point3D& pt, bool onGround);
-
- // Calculate the eta of a plane to the threshold.
- // For ground traffic this is the fastest they can get there.
- // For air traffic this is the middle approximation.
- void CalcETA(TowerPlaneRec* tpr, bool printout = false);
-
- // Iterate through all the lists and call CalcETA for all the planes.
- void doThresholdETACalc();
-
- // Order the list of traffic as per expected threshold use and flag any conflicts
- bool doThresholdUseOrder();
-
- // Calculate the crow-flys distance of a plane to the threshold in meters
- double CalcDistOutM(TowerPlaneRec* tpr);
-
- // Calculate the crow-flys distance of a plane to the threshold in miles
- double CalcDistOutMiles(TowerPlaneRec* tpr);
-
- /*
- void doCommunication();
- */
-
- void IssueLandingClearance(TowerPlaneRec* tpr);
- void IssueGoAround(TowerPlaneRec* tpr);
- void IssueDepartureClearance(TowerPlaneRec* tpr);
-
- unsigned int update_count; // Convienince counter for speading computational load over several updates
- unsigned int update_count_max; // ditto.
-
- double timeSinceLastDeparture; // Time in seconds since last departure from active rwy.
- bool departed; // set true when the above needs incrementing with time, false when it doesn't.
-
- // environment - need to make sure we're getting the surface winds and not winds aloft.
- SGPropertyNode_ptr wind_from_hdg; //degrees
- SGPropertyNode_ptr wind_speed_knots; //knots
-
- double aptElev; // Airport elevation
- string activeRwy; // Active runway number - For now we'll disregard multiple / alternate runway operation.
- RunwayDetails rwy; // Assumed to be the active one for now.
- bool rwyOccupied; // Active runway occupied flag. For now we'll disregard land-and-hold-short operations.
- FGATCAlignedProjection ortho; // Orthogonal mapping of the local area with the active runway threshold at the origin
- FGATCAlignedProjection ortho_temp; // Ortho for any runway (needed to get plane position in airport)
-
- // Figure out which runways are active.
- // For now we'll just be simple and do one active runway - eventually this will get much more complex
- // This is a private function - public interface to the results of this is through GetActiveRunway
- void DoRwyDetails();
-
- // Need a data structure to hold details of the various active planes
- // or possibly another data structure with the positions of the inactive planes.
- // Need a data structure to hold outstanding communications from aircraft.
-
- // Linked-list of planes on approach to active rwy ordered with nearest first (timewise).
- // Includes planes that have landed but not yet vacated runway.
- // Somewhat analagous to the paper strips used (used to be used?) in real life.
- // Doesn't include planes in circuit until they turn onto base/final?
- // TODO - may need to alter this for operation to more than one active rwy.
- tower_plane_rec_list_type appList;
- tower_plane_rec_list_iterator appListItr;
-
- // What should we do with planes approaching the airport to join the circuit somewhere
- // but not on straight-in though? - put them in here for now.
- tower_plane_rec_list_type circuitAppList;
- tower_plane_rec_list_iterator circuitAppListItr;
-
- // List of departed planes (planes doing circuits go into circuitList not depList after departure)
- tower_plane_rec_list_type depList;
- tower_plane_rec_list_iterator depListItr;
-
- // List of planes in the circuit (ordered by nearest to landing first)
- tower_plane_rec_list_type circuitList;
- tower_plane_rec_list_iterator circuitListItr;
-
- // List of planes waiting to depart
- tower_plane_rec_list_type holdList;
- tower_plane_rec_list_iterator holdListItr;
-
- // List of planes on rwy
- tower_plane_rec_list_type rwyList;
- tower_plane_rec_list_iterator rwyListItr;
-
- // List of all planes due to use a given rwy arranged in projected order of rwy use
- tower_plane_rec_list_type trafficList; // TODO - needs to be expandable to more than one rwy
- tower_plane_rec_list_iterator trafficListItr;
-
- // List of planes that have vacated the runway inbound but not yet handed off to ground
- tower_plane_rec_list_type vacatedList;
- tower_plane_rec_list_iterator vacatedListItr;
-
- // Returns true if successful
- bool RemoveFromTrafficList(const string& id);
- bool RemoveFromAppList(const string& id);
- bool RemoveFromRwyList(const string& id);
-
- // Return the ETA of plane no. list_pos (1-based) in the traffic list.
- // i.e. list_pos = 1 implies next to use runway.
- double GetTrafficETA(unsigned int list_pos, bool printout = false);
-
- // Add a tower plane rec with ETA to the traffic list in the correct position ETA-wise.
- // Returns true if this could cause a threshold ETA conflict with other traffic, false otherwise.
- bool AddToTrafficList(TowerPlaneRec* t, bool holding = false);
-
- bool AddToCircuitList(TowerPlaneRec* t);
-
- // Add to vacated list only if not already present
- void AddToVacatedList(TowerPlaneRec* t);
-
- void AddToHoldingList(TowerPlaneRec* t);
-
- // Ground can be separate or handled by tower in real life.
- // In the program we will always use a separate FGGround class, but we need to know
- // whether it is supposed to be separate or not to give the correct instructions.
- bool separateGround; // true if ground control is separate
- FGGround* ground; // The ground control associated with this airport.
-
- bool _departureControlled; // true if we need to hand off departing traffic to departure control
- //FGDeparture* _departure; // The relevant departure control (once we've actually written it!)
-
- // for failure modeling
- string trans_ident; // transmitted ident
- bool tower_failed; // tower failed?
-
- // Pointers to current users position and orientation
- SGPropertyNode_ptr user_lon_node;
- SGPropertyNode_ptr user_lat_node;
- SGPropertyNode_ptr user_elev_node;
- SGPropertyNode_ptr user_hdg_node;
-
- // Details of the general traffic flow etc in the circuit
- double crosswind_leg_pos; // Distance from threshold crosswind leg is being turned to in meters (actual operation - *not* ideal circuit)
- double downwind_leg_pos; // Actual offset distance in meters from the runway that planes are flying the downwind leg
- // Currently not sure whether the above should be always +ve or just take the natural orthopos sign (+ve for RH circuit, -ve for LH).
- double base_leg_pos; // Actual offset distance from the threshold (-ve) that planes are turning to base leg.
-
- double nominal_crosswind_leg_pos;
- double nominal_downwind_leg_pos;
- double nominal_base_leg_pos;
-
- friend istream& operator>> ( istream&, FGTower& );
-};
-
-#endif //_FG_TOWER_HXX
+++ /dev/null
-// 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 <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 {
- cout << "Too many tokens" << endl;
- }
- }
- }
-
- 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;
-}
+++ /dev/null
-// 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>
-
-#ifdef SG_HAVE_STD_INCLUDES
-# include <istream>
-#include <iomanip>
-#elif defined( SG_HAVE_NATIVE_SGI_COMPILERS )
-# include <iostream.h>
-#elif defined( __BORLANDC__ )
-# include <iostream>
-#else
-# include <istream.h>
-#include <iomanip.h>
-#endif
-
-#include "ATC.hxx"
-
-#if ! defined( SG_HAVE_NATIVE_SGI_COMPILERS )
-SG_USING_STD(istream);
-#endif
-
-SG_USING_STD(string);
-
-struct TransCode {
- int c1;
- int c2;
- int c3;
-};
-
-// TransPar - a representation of the logic of a parsed speech transmission
-struct TransPar {
- string station;
- string callsign;
- string airport;
- string intention; // landing, crossing
- 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;
- 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.
- string TransText; // The text of the spoken transmission
- 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 string& get_transtext() { return TransText; }
- inline const string& get_menutext() { return MenuText; }
-
- // Return the parsed logic of the transmission
- TransPar Parse();
-
-private:
-
- friend istream& operator>> ( istream&, FGTransmission& );
-
-};
-
-
-inline istream&
-operator >> ( 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
+++ /dev/null
-// 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;
-
-#ifdef __MWERKS__
-
- char c = 0;
- while ( in.get(c) && c != '\0' ) {
- in.putback(c);
- in >> a;
- if ( a.get_type() != '[' ) {
- transmissionlist_code[a.get_station()].push_back(a);
- }
- in >> skipcomment;
- }
-
-#else
-
- 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;
- */
- }
-
-#endif
-
- // 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 {
- cout << "Transmissionlist error: Too many transmissions" << endl;
- }
- }
-
- if ( num_trans != 0 ) return true;
- else {
- cout << "No transmission with station " << station << "found." << endl;
- 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 {
- cout << "Tag " << tag << " not found" << endl;
- break;
- }
- strcat( &dum[0], &mes[len+3] );
- strcpy( &mes[0], &dum[0] );
-
- ++check;
- if(check > 10) {
- SG_LOG(SG_ATC, SG_WARN, "WARNING: Possibly endless loop terminated in FGTransmissionlist::gen_text(...)");
- break;
- }
- }
-
- //cout << mes << endl;
- break;
- }
- }
- return mes[0] ? mes : "No transmission found";
-}
-
-
+++ /dev/null
-// 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"
-
-SG_USING_STD(map);
-SG_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
#include <simgear/math/sg_geodesy.hxx>
#include <simgear/math/polar3d.hxx>
#include SG_GLU_H
-#include <ATC/ATCutils.hxx>
+#include <ATCDCL/ATCutils.hxx>
// int x, int y, int width, int height, float scale_data, bool working)
#include <Environment/environment_mgr.hxx>
#include <Main/viewer.hxx>
#include <Main/viewmgr.hxx>
-#include <ATC/ATCutils.hxx>
+#include <ATCDCL/ATCutils.hxx>
#include "HUD.hxx"
#include "kln89_symbols.hxx"
#include <iostream>
-#include <ATC/ATCProjection.hxx>
+#include <ATCDCL/ATCProjection.hxx>
#include <Main/fg_props.hxx>
#include <simgear/math/point3d.hxx>
#endif
#include "kln89_page_apt.hxx"
-#include <ATC/commlist.hxx>
+#include <ATCDCL/commlist.hxx>
#include <Main/globals.hxx>
// This function is copied from Airports/runways.cxx
#include <Airports/runways.hxx>
#include <Airports/simple.hxx>
#include <AIModel/AIManager.hxx>
-#include <ATC/ATCmgr.hxx>
-#include <ATC/AIMgr.hxx>
+#include <ATCDCL/ATCmgr.hxx>
+#include <ATCDCL/AIMgr.hxx>
#include <Autopilot/route_mgr.hxx>
#include <Autopilot/xmlauto.hxx>
#include <Cockpit/cockpit.hxx>
#include <Aircraft/controls.hxx>
#include <Airports/runways.hxx>
-#include <ATC/AIMgr.hxx>
-#include <ATC/ATCmgr.hxx>
+#include <ATCDCL/AIMgr.hxx>
+#include <ATCDCL/ATCmgr.hxx>
#include <Autopilot/route_mgr.hxx>
#include <Cockpit/panel.hxx>
#include <GUI/new_gui.hxx>
#include <Sound/beacon.hxx>
#include <Sound/morse.hxx>
#include <FDM/flight.hxx>
-#include <ATC/ATCmgr.hxx>
-#include <ATC/AIMgr.hxx>
+#include <ATCDCL/ATCmgr.hxx>
+#include <ATCDCL/AIMgr.hxx>
#include <Time/tmp.hxx>
#include <Time/fg_timer.hxx>
#include <Environment/environment_mgr.hxx>
Include \
Aircraft \
Airports \
- ATC \
+ ATCDCL \
Autopilot \
Cockpit \
Environment \
projects / flightgear.git / commitdiff