1 // navrecord.cxx -- generic vor/dme/ndb class
3 // Written by Curtis Olson, started May 2004.
5 // Copyright (C) 2004 Curtis L. Olson - http://www.flightgear.org/~curt
7 // This program is free software; you can redistribute it and/or
8 // modify it under the terms of the GNU General Public License as
9 // published by the Free Software Foundation; either version 2 of the
10 // License, or (at your option) any later version.
12 // This program is distributed in the hope that it will be useful, but
13 // WITHOUT ANY WARRANTY; without even the implied warranty of
14 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 // General Public License for more details.
17 // You should have received a copy of the GNU General Public License
18 // along with this program; if not, write to the Free Software
19 // Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
29 #include <simgear/misc/sgstream.hxx>
30 #include <simgear/misc/sg_path.hxx>
31 #include <simgear/structure/exception.hxx>
32 #include <simgear/debug/logstream.hxx>
33 #include <simgear/sg_inlines.h>
34 #include <simgear/props/props.hxx>
35 #include <simgear/props/props_io.hxx>
37 #include <Navaids/navrecord.hxx>
38 #include <Navaids/navdb.hxx>
39 #include <Airports/runways.hxx>
40 #include <Airports/simple.hxx>
41 #include <Airports/xmlloader.hxx>
43 #include <Main/fg_props.hxx>
45 FGNavRecord::FGNavRecord(Type aTy, const std::string& aIdent,
46 const std::string& aName, const SGGeod& aPos,
47 int aFreq, int aRange, double aMultiuse) :
48 FGPositioned(aTy, aIdent, aPos),
57 initAirportRelation();
59 // Ranges are included with the latest data format, no need to
60 // assign our own defaults, unless the range is not set for some
63 SG_LOG(SG_GENERAL, SG_WARN, "navaid " << ident() << " has no range set, using defaults");
67 range = FG_NAV_DEFAULT_RANGE;
73 range = FG_LOC_DEFAULT_RANGE;
77 range = FG_DME_DEFAULT_RANGE;
81 range = FG_LOC_DEFAULT_RANGE;
87 void FGNavRecord::initAirportRelation()
89 if ((type() < ILS) || (type() > GS)) {
90 return; // not airport-located
93 mRunway = getRunwayFromName(_name);
96 readAirportSceneryData();
99 // fudge elevation to the runway elevation if it's not specified
100 if (fabs(elevation()) < 0.01) {
101 mPosition.setElevationFt(mRunway->elevation());
104 if (type() == ILS || type() == LOC) {
105 mRunway->setILS(this);
108 // align localizers with their runway
109 if ((type() == ILS) || (type() == LOC)) {
110 if (!fgGetBool("/sim/navdb/localizers/auto-align", true)) {
115 = fgGetDouble( "/sim/navdb/localizers/auto-align-threshold-deg", 5.0 );
116 alignLocaliserWithRunway(threshold);
120 void FGNavRecord::readAirportSceneryData()
122 // allow users to disable the scenery data in the short-term
123 // longer term, this option can probably disappear
124 if (!fgGetBool("/sim/use-scenery-airport-data")) {
129 SGPropertyNode_ptr rootNode = new SGPropertyNode;
130 if (!XMLLoader::findAirportData(mRunway->airport()->ident(), "ils", path)) {
134 readProperties(path.str(), rootNode);
135 SGPropertyNode* runwayNode, *ilsNode;
136 for (int i=0; (runwayNode = rootNode->getChild("runway", i)) != NULL; ++i) {
137 for (int j=0; (ilsNode = runwayNode->getChild("ils", j)) != NULL; ++j) {
138 // must match on both nav-ident and runway ident, to support the following:
139 // - runways with multiple distinct ILS installations (KEWD, for example)
140 // - runways where both ends share the same nav ident (LFAT, for example)
141 if ((ilsNode->getStringValue("nav-id") == ident()) &&
142 (ilsNode->getStringValue("rwy") == mRunway->ident())) {
143 processSceneryILS(ilsNode);
146 } // of ILS iteration
147 } // of runway iteration
150 void FGNavRecord::processSceneryILS(SGPropertyNode* aILSNode)
152 double hdgDeg = aILSNode->getDoubleValue("hdg-deg"),
153 lon = aILSNode->getDoubleValue("lon"),
154 lat = aILSNode->getDoubleValue("lat"),
155 elevM = aILSNode->getDoubleValue("elev-m");
157 mPosition = SGGeod::fromDegM(lon, lat, elevM);
161 void FGNavRecord::alignLocaliserWithRunway(double aThreshold)
163 // find the distance from the threshold to the localizer
164 double dist = SGGeodesy::distanceM(mPosition, mRunway->threshold());
166 // back project that distance along the runway center line
167 SGGeod newPos = mRunway->pointOnCenterline(dist);
169 double hdg_diff = get_multiuse() - mRunway->headingDeg();
170 SG_NORMALIZE_RANGE(hdg_diff, -180.0, 180.0);
172 if ( fabs(hdg_diff) <= aThreshold ) {
173 mPosition = SGGeod::fromGeodFt(newPos, mPosition.getElevationFt());
174 set_multiuse( mRunway->headingDeg() );
176 SG_LOG(SG_GENERAL, SG_DEBUG, "localizer:" << ident() << ", aligning with runway "
177 << mRunway->ident() << " exceeded heading threshold");
181 FGTACANRecord::FGTACANRecord(void) :
189 operator >> ( std::istream& in, FGTACANRecord& n )
191 in >> n.channel >> n.freq ;
192 //getline( in, n.name );