dd2eec7bd8
procedures, and routing algorithms, and modify the GPS, route manager and WaypointList to use the new objects.
200 lines
5.2 KiB
C++
200 lines
5.2 KiB
C++
// runways.cxx -- a simple class to manage airport runway info
|
|
//
|
|
// Written by Curtis Olson, started August 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
|
|
|
|
#include <cstdio> // sprintf()
|
|
#include <cstdlib> // atoi()
|
|
#include <cassert>
|
|
|
|
#include <simgear/compiler.h>
|
|
|
|
#include <simgear/props/props.hxx>
|
|
|
|
#include <string>
|
|
|
|
#include "runways.hxx"
|
|
|
|
#include <Airports/simple.hxx>
|
|
#include <Navaids/procedure.hxx>
|
|
|
|
using std::string;
|
|
|
|
static std::string cleanRunwayNo(const std::string& aRwyNo)
|
|
{
|
|
if (aRwyNo[0] == 'x') {
|
|
return std::string(); // no ident for taxiways
|
|
}
|
|
|
|
string result(aRwyNo);
|
|
// canonicalise runway ident
|
|
if ((aRwyNo.size() == 1) || !isdigit(aRwyNo[1])) {
|
|
result = "0" + aRwyNo;
|
|
}
|
|
|
|
// trim off trailing garbage
|
|
if (result.size() > 2) {
|
|
char suffix = toupper(result[2]);
|
|
if (suffix == 'X') {
|
|
result = result.substr(0, 2);
|
|
}
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
FGRunway::FGRunway(FGAirport* aAirport, const string& aIdent,
|
|
const SGGeod& aGeod,
|
|
const double heading, const double length,
|
|
const double width,
|
|
const double displ_thresh,
|
|
const double stopway,
|
|
const int surface_code,
|
|
bool reciprocal) :
|
|
FGRunwayBase(RUNWAY, cleanRunwayNo(aIdent), aGeod, heading, length, width, surface_code, true),
|
|
_airport(aAirport),
|
|
_isReciprocal(reciprocal),
|
|
_reciprocal(NULL),
|
|
_displ_thresh(displ_thresh),
|
|
_stopway(stopway),
|
|
_ils(NULL)
|
|
{
|
|
}
|
|
|
|
string FGRunway::reverseIdent(const string& aRunwayIdent)
|
|
{
|
|
// Helipads don't have a seperate number per end
|
|
if (aRunwayIdent.size() && (aRunwayIdent[0] == 'H' || aRunwayIdent[0] == 'h' || aRunwayIdent[0] == 'x')) {
|
|
return aRunwayIdent;
|
|
}
|
|
|
|
std::string ident(aRunwayIdent);
|
|
|
|
char buf[4];
|
|
int rn = atoi(ident.substr(0,2).c_str());
|
|
rn += 18;
|
|
while(rn > 36) {
|
|
rn -= 36;
|
|
}
|
|
|
|
sprintf(buf, "%02i", rn);
|
|
if(ident.size() == 3) {
|
|
char suffix = toupper(ident[2]);
|
|
if(suffix == 'L') {
|
|
buf[2] = 'R';
|
|
} else if (suffix == 'R') {
|
|
buf[2] = 'L';
|
|
} else {
|
|
// something else, just copy
|
|
buf[2] = suffix;
|
|
}
|
|
|
|
buf[3] = 0;
|
|
}
|
|
|
|
return buf;
|
|
}
|
|
|
|
double FGRunway::score(double aLengthWt, double aWidthWt, double aSurfaceWt) const
|
|
{
|
|
int surface = 1;
|
|
if (_surface_code == 12 || _surface_code == 5) // dry lakebed & gravel
|
|
surface = 2;
|
|
else if (_surface_code == 1 || _surface_code == 2) // asphalt & concrete
|
|
surface = 3;
|
|
|
|
return _length * aLengthWt + _width * aWidthWt + surface * aSurfaceWt + 1e-20;
|
|
}
|
|
|
|
SGGeod FGRunway::begin() const
|
|
{
|
|
return pointOnCenterline(0.0);
|
|
}
|
|
|
|
SGGeod FGRunway::end() const
|
|
{
|
|
return pointOnCenterline(lengthM());
|
|
}
|
|
|
|
SGGeod FGRunway::threshold() const
|
|
{
|
|
return pointOnCenterline(_displ_thresh * SG_FEET_TO_METER);
|
|
}
|
|
|
|
void FGRunway::processThreshold(SGPropertyNode* aThreshold)
|
|
{
|
|
assert(ident() == aThreshold->getStringValue("rwy"));
|
|
|
|
double lon = aThreshold->getDoubleValue("lon"),
|
|
lat = aThreshold->getDoubleValue("lat");
|
|
SGGeod newThreshold(SGGeod::fromDegM(lon, lat, mPosition.getElevationM()));
|
|
|
|
_heading = aThreshold->getDoubleValue("hdg-deg");
|
|
_displ_thresh = aThreshold->getDoubleValue("displ-m") * SG_METER_TO_FEET;
|
|
_stopway = aThreshold->getDoubleValue("stopw-m") * SG_METER_TO_FEET;
|
|
|
|
// compute the new runway center, based on the threshold lat/lon and length,
|
|
double offsetFt = (0.5 * _length);
|
|
SGGeod newCenter;
|
|
double dummy;
|
|
SGGeodesy::direct(newThreshold, _heading, offsetFt * SG_FEET_TO_METER, newCenter, dummy);
|
|
mPosition = newCenter;
|
|
}
|
|
|
|
void FGRunway::setReciprocalRunway(FGRunway* other)
|
|
{
|
|
assert(_reciprocal==NULL);
|
|
assert((other->_reciprocal == NULL) || (other->_reciprocal == this));
|
|
|
|
_reciprocal = other;
|
|
}
|
|
|
|
std::vector<flightgear::SID*> FGRunway::getSIDs()
|
|
{
|
|
std::vector<flightgear::SID*> result;
|
|
for (unsigned int i=0; i<_airport->numSIDs(); ++i) {
|
|
flightgear::SID* s = _airport->getSIDByIndex(i);
|
|
if (s->isForRunway(this)) {
|
|
result.push_back(s);
|
|
}
|
|
} // of SIDs at the airport iteration
|
|
|
|
return result;
|
|
}
|
|
|
|
std::vector<flightgear::STAR*> FGRunway::getSTARs()
|
|
{
|
|
std::vector<flightgear::STAR*> result;
|
|
for (unsigned int i=0; i<_airport->numSTARs(); ++i) {
|
|
flightgear::STAR* s = _airport->getSTARByIndex(i);
|
|
if (s->isForRunway(this)) {
|
|
result.push_back(s);
|
|
}
|
|
} // of STARs at the airport iteration
|
|
|
|
return result;
|
|
}
|
|
|
|
|