#include <istream>
#include <simgear/misc/sgstream.hxx>
+#include <simgear/misc/sg_path.hxx>
#include <simgear/structure/exception.hxx>
#include <simgear/debug/logstream.hxx>
+#include <simgear/sg_inlines.h>
+#include <simgear/props/props.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>
FGNavRecord::FGNavRecord(Type aTy, const std::string& aIdent,
range(aRange),
multiuse(aMultiuse),
_name(aName),
- serviceable(true),
- trans_ident(aIdent)
+ mRunway(NULL),
+ serviceable(true)
{
initAirportRelation();
// 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");
+ SG_LOG(SG_GENERAL, SG_DEBUG, "navaid " << ident() << " has no range set, using defaults");
switch (type()) {
case NDB:
case VOR:
}
}
+ init(true); // init FGPositioned (now position is adjusted)
}
void FGNavRecord::initAirportRelation()
return; // not airport-located
}
- FGRunway* runway = getRunwayFromName(_name);
+ mRunway = getRunwayFromName(_name);
+ if (!mRunway) {
+ return;
+ }
+
+ if (type() != GS) {
+ SGPropertyNode* ilsData = ilsDataForRunwayAndNavaid(mRunway, ident());
+ if (ilsData) {
+ processSceneryILS(ilsData);
+ }
+ }
+
// fudge elevation to the runway elevation if it's not specified
if (fabs(elevation()) < 0.01) {
- mPosition.setElevationFt(runway->elevation());
+ mPosition.setElevationFt(mRunway->elevation());
+ }
+
+ if (type() == ILS || type() == LOC) {
+ mRunway->setILS(this);
}
// align localizers with their runway
double threshold
= fgGetDouble( "/sim/navdb/localizers/auto-align-threshold-deg", 5.0 );
- alignLocaliserWithRunway(runway, threshold);
+ alignLocaliserWithRunway(threshold);
}
}
-void FGNavRecord::alignLocaliserWithRunway(FGRunway* aRunway, double aThreshold)
+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(aRunway->threshold());
- double dist, az1, az2;
- SGGeodesy::inverse(mPosition, runwayThreshold, az1, az2, dist);
+ double dist = SGGeodesy::distanceM(mPosition, mRunway->threshold());
// back project that distance along the runway center line
- SGGeod newPos = aRunway->pointOnCenterline(dist);
+ SGGeod newPos = mRunway->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;
- }
+ double hdg_diff = get_multiuse() - mRunway->headingDeg();
+ SG_NORMALIZE_RANGE(hdg_diff, -180.0, 180.0);
if ( fabs(hdg_diff) <= aThreshold ) {
- mPosition = newPos;
- set_multiuse( aRunway->headingDeg() );
+ mPosition = SGGeod::fromGeodFt(newPos, mPosition.getElevationFt());
+ set_multiuse( mRunway->headingDeg() );
} else {
- SG_LOG(SG_GENERAL, SG_WARN, "localizer:" << ident() << ", aligning with runway "
- << aRunway->ident() << " exceeded heading threshold");
+ SG_LOG(SG_GENERAL, SG_DEBUG, "localizer:" << ident() << ", aligning with runway "
+ << mRunway->ident() << " exceeded heading threshold");
+ }
+}
+
+double FGNavRecord::localizerWidth() const
+{
+ if (!mRunway) {
+ return 6.0;
}
+
+ SGVec3d thresholdCart(SGVec3d::fromGeod(mRunway->threshold()));
+ double axisLength = dist(cart(), thresholdCart);
+ double landingLength = dist(thresholdCart, SGVec3d::fromGeod(mRunway->end()));
+
+// 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;
+ }
+
+// 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;
+
}
FGTACANRecord::FGTACANRecord(void) :