#include <simgear/debug/logstream.hxx>
#include <simgear/sg_inlines.h>
#include <simgear/props/props.hxx>
-#include <simgear/props/props_io.hxx>
+
#include <Navaids/navrecord.hxx>
#include <Navaids/navdb.hxx>
#include <Airports/runways.hxx>
#include <Airports/simple.hxx>
#include <Airports/xmlloader.hxx>
-
#include <Main/fg_props.hxx>
+#include <Navaids/NavDataCache.hxx>
-FGNavRecord::FGNavRecord(Type aTy, const std::string& aIdent,
+FGNavRecord::FGNavRecord(PositionedID aGuid, Type aTy, const std::string& aIdent,
const std::string& aName, const SGGeod& aPos,
- int aFreq, int aRange, double aMultiuse) :
- FGPositioned(aTy, aIdent, aPos),
+ int aFreq, int aRange, double aMultiuse, PositionedID aRunway) :
+ FGPositioned(aGuid, aTy, aIdent, aPos),
freq(aFreq),
range(aRange),
multiuse(aMultiuse),
- _name(aName),
- mRunway(NULL),
- serviceable(true),
- trans_ident(aIdent)
+ mName(aName),
+ mRunway(aRunway),
+ serviceable(true)
{
- 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;
- }
- }
-
}
-void FGNavRecord::initAirportRelation()
+FGRunway* FGNavRecord::runway() const
{
- if ((type() < ILS) || (type() > GS)) {
- return; // not airport-located
- }
-
- mRunway = getRunwayFromName(_name);
-
- if (type() != GS) {
- readAirportSceneryData();
- }
-
- // fudge elevation to the runway elevation if it's not specified
- if (fabs(elevation()) < 0.01) {
- mPosition.setElevationFt(mRunway->elevation());
- }
-
- if (type() == ILS) {
- mRunway->setILS(this);
- }
-
- // align localizers with their runway
- if ((type() == ILS) || (type() == LOC)) {
- if (!fgGetBool("/sim/navdb/localizers/auto-align", true)) {
- return;
- }
-
- double threshold
- = fgGetDouble( "/sim/navdb/localizers/auto-align-threshold-deg", 5.0 );
- alignLocaliserWithRunway(threshold);
- }
+ return (FGRunway*) flightgear::NavDataCache::instance()->loadById(mRunway);
}
-void FGNavRecord::readAirportSceneryData()
+double FGNavRecord::localizerWidth() const
{
- // allow users to disable the scenery data in the short-term
- // longer term, this option can probably disappear
- if (!fgGetBool("/sim/use-scenery-airport-data")) {
- return;
+ if (!mRunway) {
+ return 6.0;
}
- SGPath path;
- SGPropertyNode_ptr rootNode = new SGPropertyNode;
- if (!XMLLoader::findAirportData(mRunway->airport()->ident(), "ils", path)) {
- return;
- }
+ FGRunway* rwy = runway();
+ SGVec3d thresholdCart(SGVec3d::fromGeod(rwy->threshold()));
+ double axisLength = dist(cart(), thresholdCart);
+ double landingLength = dist(thresholdCart, SGVec3d::fromGeod(rwy->end()));
- readProperties(path.str(), rootNode);
- SGPropertyNode* runwayNode, *ilsNode;
- for (int i=0; (runwayNode = rootNode->getChild("runway", i)) != NULL; ++i) {
- for (int j=0; (ilsNode = runwayNode->getChild("ils", j)) != NULL; ++j) {
- // must match on both nav-ident and runway ident, to support the following:
- // - runways with multiple distinct ILS installations (KEWD, for example)
- // - runways where both ends share the same nav ident (LFAT, for example)
- if ((ilsNode->getStringValue("nav-id") == ident()) &&
- (ilsNode->getStringValue("rwy") == mRunway->ident())) {
- processSceneryILS(ilsNode);
- return;
- }
- } // of ILS iteration
- } // of runway iteration
-}
-
-void FGNavRecord::processSceneryILS(SGPropertyNode* aILSNode)
-{
- double hdgDeg = aILSNode->getDoubleValue("hdg-deg"),
- lon = aILSNode->getDoubleValue("lon"),
- lat = aILSNode->getDoubleValue("lat"),
- elevM = aILSNode->getDoubleValue("elev-m");
-
- mPosition = SGGeod::fromDegM(lon, lat, elevM);
- multiuse = hdgDeg;
-}
-
-void FGNavRecord::alignLocaliserWithRunway(double aThreshold)
-{
-// find the distance from the threshold to the localizer
- SGGeod runwayThreshold(mRunway->threshold());
- double dist, az1, az2;
- SGGeodesy::inverse(mPosition, runwayThreshold, az1, az2, dist);
-
-// back project that distance along the runway center line
- SGGeod newPos = mRunway->pointOnCenterline(dist);
+// Reference: http://dcaa.slv.dk:8000/icaodocs/
+// ICAO standard width at threshold is 210 m = 689 feet = approx 700 feet.
+// ICAO 3.1.1 half course = DDM = 0.0775
+// ICAO 3.1.3.7.1 Sensitivity 0.00145 DDM/m at threshold
+// implies peg-to-peg of 214 m ... we will stick with 210.
+// ICAO 3.1.3.7.1 "Course sector angle shall not exceed 6 degrees."
+
+// Very short runway: less than 1200 m (4000 ft) landing length:
+ if (landingLength < 1200.0) {
+// ICAO fudges localizer sensitivity for very short runways.
+// This produces a non-monotonic sensitivity-versus length relation.
+ axisLength += 1050.0;
+ }
- double hdg_diff = get_multiuse() - mRunway->headingDeg();
- SG_NORMALIZE_RANGE(hdg_diff, -180.0, 180.0);
+// Example: very short: San Diego KMYF (Montgomery Field) ILS RWY 28R
+// Example: short: Tom's River KMJX (Robert J. Miller) ILS RWY 6
+// Example: very long: Denver KDEN (Denver) ILS RWY 16R
+ double raw_width = 210.0 / axisLength * SGD_RADIANS_TO_DEGREES;
+ return raw_width < 6.0? raw_width : 6.0;
- if ( fabs(hdg_diff) <= aThreshold ) {
- mPosition = newPos;
- set_multiuse( mRunway->headingDeg() );
- } else {
- SG_LOG(SG_GENERAL, SG_WARN, "localizer:" << ident() << ", aligning with runway "
- << mRunway->ident() << " exceeded heading threshold");
- }
}
FGTACANRecord::FGTACANRecord(void) :
projects / flightgear.git / blobdiff