2008-08-03 14:34:42 +00:00
|
|
|
// navrecord.cxx -- generic vor/dme/ndb class
|
|
|
|
//
|
|
|
|
// Written by Curtis Olson, started May 2004.
|
|
|
|
//
|
|
|
|
// Copyright (C) 2004 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 <istream>
|
|
|
|
|
2008-09-12 08:46:15 +00:00
|
|
|
#include <simgear/misc/sgstream.hxx>
|
|
|
|
#include <simgear/structure/exception.hxx>
|
|
|
|
#include <simgear/debug/logstream.hxx>
|
2008-08-03 14:34:42 +00:00
|
|
|
|
2008-09-12 08:46:15 +00:00
|
|
|
#include "Navaids/navrecord.hxx"
|
2009-01-03 15:54:03 +00:00
|
|
|
#include "Navaids/navdb.hxx"
|
2008-09-12 08:46:15 +00:00
|
|
|
#include "Airports/runways.hxx"
|
|
|
|
#include "Main/fg_props.hxx"
|
|
|
|
|
|
|
|
FGNavRecord::FGNavRecord(Type aTy, const std::string& aIdent,
|
2008-12-24 14:48:30 +00:00
|
|
|
const std::string& aName, const SGGeod& aPos,
|
2008-09-12 08:46:15 +00:00
|
|
|
int aFreq, int aRange, double aMultiuse) :
|
2008-12-24 14:48:30 +00:00
|
|
|
FGPositioned(aTy, aIdent, aPos),
|
2008-08-03 14:34:42 +00:00
|
|
|
freq(aFreq),
|
|
|
|
range(aRange),
|
|
|
|
multiuse(aMultiuse),
|
2008-12-25 23:11:43 +00:00
|
|
|
_name(aName),
|
2008-08-03 14:34:42 +00:00
|
|
|
serviceable(true),
|
|
|
|
trans_ident(aIdent)
|
2008-09-12 08:46:15 +00:00
|
|
|
{
|
|
|
|
initAirportRelation();
|
|
|
|
|
|
|
|
// Ranges are included with the latest data format, no need to
|
|
|
|
// assign our own defaults, unless the range is not set for some
|
|
|
|
// reason.
|
|
|
|
if (range < 0.1) {
|
|
|
|
SG_LOG(SG_GENERAL, SG_WARN, "navaid " << ident() << " has no range set, using defaults");
|
|
|
|
switch (type()) {
|
|
|
|
case NDB:
|
|
|
|
case VOR:
|
|
|
|
range = FG_NAV_DEFAULT_RANGE;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case LOC:
|
|
|
|
case ILS:
|
|
|
|
case GS:
|
|
|
|
range = FG_LOC_DEFAULT_RANGE;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case DME:
|
|
|
|
range = FG_DME_DEFAULT_RANGE;
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
range = FG_LOC_DEFAULT_RANGE;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2008-08-03 14:34:42 +00:00
|
|
|
}
|
|
|
|
|
2008-09-12 08:46:15 +00:00
|
|
|
void FGNavRecord::initAirportRelation()
|
|
|
|
{
|
2009-01-03 15:54:03 +00:00
|
|
|
if ((type() < ILS) || (type() > GS)) {
|
2008-09-12 08:46:15 +00:00
|
|
|
return; // not airport-located
|
|
|
|
}
|
|
|
|
|
2009-01-03 15:54:03 +00:00
|
|
|
FGRunway* runway = getRunwayFromName(_name);
|
|
|
|
// fudge elevation to the runway elevation if it's not specified
|
2008-09-12 08:46:15 +00:00
|
|
|
if (fabs(elevation()) < 0.01) {
|
2009-01-03 15:54:03 +00:00
|
|
|
mPosition.setElevationFt(runway->elevation());
|
2008-09-12 08:46:15 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
// align localizers with their runway
|
|
|
|
if ((type() == ILS) || (type() == LOC)) {
|
|
|
|
if (!fgGetBool("/sim/navdb/localizers/auto-align", true)) {
|
|
|
|
return;
|
2008-08-03 14:34:42 +00:00
|
|
|
}
|
|
|
|
|
2008-12-25 23:11:43 +00:00
|
|
|
double threshold
|
|
|
|
= fgGetDouble( "/sim/navdb/localizers/auto-align-threshold-deg", 5.0 );
|
2008-09-12 08:46:15 +00:00
|
|
|
alignLocaliserWithRunway(runway, threshold);
|
|
|
|
}
|
2008-08-03 14:34:42 +00:00
|
|
|
}
|
|
|
|
|
2008-09-12 08:46:15 +00:00
|
|
|
void FGNavRecord::alignLocaliserWithRunway(FGRunway* aRunway, double aThreshold)
|
|
|
|
{
|
|
|
|
// find the distance from the threshold to the localizer
|
|
|
|
SGGeod runwayThreshold(aRunway->threshold());
|
|
|
|
double dist, az1, az2;
|
|
|
|
SGGeodesy::inverse(mPosition, runwayThreshold, az1, az2, dist);
|
|
|
|
|
|
|
|
// back project that distance along the runway center line
|
|
|
|
SGGeod newPos = aRunway->pointOnCenterline(dist);
|
|
|
|
|
|
|
|
double hdg_diff = get_multiuse() - aRunway->headingDeg();
|
|
|
|
|
|
|
|
// clamp to [-180.0 ... 180.0]
|
|
|
|
if ( hdg_diff < -180.0 ) {
|
|
|
|
hdg_diff += 360.0;
|
|
|
|
} else if ( hdg_diff > 180.0 ) {
|
|
|
|
hdg_diff -= 360.0;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ( fabs(hdg_diff) <= aThreshold ) {
|
|
|
|
mPosition = newPos;
|
|
|
|
set_multiuse( aRunway->headingDeg() );
|
|
|
|
} else {
|
|
|
|
SG_LOG(SG_GENERAL, SG_WARN, "localizer:" << ident() << ", aligning with runway "
|
2008-12-24 14:48:30 +00:00
|
|
|
<< aRunway->ident() << " exceeded heading threshold");
|
2008-09-12 08:46:15 +00:00
|
|
|
}
|
|
|
|
}
|
2008-08-03 14:34:42 +00:00
|
|
|
|
|
|
|
FGTACANRecord::FGTACANRecord(void) :
|
|
|
|
channel(""),
|
|
|
|
freq(0)
|
|
|
|
|
|
|
|
{
|
|
|
|
}
|
|
|
|
|
|
|
|
std::istream&
|
|
|
|
operator >> ( std::istream& in, FGTACANRecord& n )
|
|
|
|
{
|
|
|
|
in >> n.channel >> n.freq ;
|
|
|
|
//getline( in, n.name );
|
|
|
|
|
|
|
|
return in;
|
|
|
|
}
|