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>
37 #include <Navaids/navrecord.hxx>
38 #include <Navaids/navdb.hxx>
39 #include <Airports/runways.hxx>
40 #include <Airports/airport.hxx>
41 #include <Airports/xmlloader.hxx>
42 #include <Main/fg_props.hxx>
44 FGNavRecord::FGNavRecord(PositionedID aGuid, Type aTy, const std::string& aIdent,
45 const std::string& aName, const SGGeod& aPos,
46 int aFreq, int aRange, double aMultiuse, PositionedID aRunway) :
47 FGPositioned(aGuid, aTy, aIdent, aPos),
58 FGRunwayRef FGNavRecord::runway() const
60 return loadById<FGRunway>(mRunway);
63 double FGNavRecord::localizerWidth() const
69 FGRunway* rwy = runway();
70 SGVec3d thresholdCart(SGVec3d::fromGeod(rwy->threshold()));
71 double axisLength = dist(cart(), thresholdCart);
72 double landingLength = dist(thresholdCart, SGVec3d::fromGeod(rwy->end()));
74 // Reference: http://dcaa.slv.dk:8000/icaodocs/
75 // ICAO standard width at threshold is 210 m = 689 feet = approx 700 feet.
76 // ICAO 3.1.1 half course = DDM = 0.0775
77 // ICAO 3.1.3.7.1 Sensitivity 0.00145 DDM/m at threshold
78 // implies peg-to-peg of 214 m ... we will stick with 210.
79 // ICAO 3.1.3.7.1 "Course sector angle shall not exceed 6 degrees."
81 // Very short runway: less than 1200 m (4000 ft) landing length:
82 if (landingLength < 1200.0) {
83 // ICAO fudges localizer sensitivity for very short runways.
84 // This produces a non-monotonic sensitivity-versus length relation.
88 // Example: very short: San Diego KMYF (Montgomery Field) ILS RWY 28R
89 // Example: short: Tom's River KMJX (Robert J. Miller) ILS RWY 6
90 // Example: very long: Denver KDEN (Denver) ILS RWY 16R
91 double raw_width = 210.0 / axisLength * SGD_RADIANS_TO_DEGREES;
92 return raw_width < 6.0? raw_width : 6.0;
96 bool FGNavRecord::hasDME()
98 return (mColocated > 0);
103 bool FGNavRecord::isVORTAC() const
108 return mName.find(" VORTAC") != std::string::npos;
111 void FGNavRecord::setColocatedDME(PositionedID other)
116 void FGNavRecord::updateFromXML(const SGGeod& geod, double heading)
118 modifyPosition(geod);
122 //------------------------------------------------------------------------------
123 FGMobileNavRecord::FGMobileNavRecord( PositionedID aGuid,
125 const std::string& ident,
126 const std::string& name,
131 PositionedID aRunway ):
132 FGNavRecord(aGuid, type, ident, name, aPos, freq, range, multiuse, aRunway),
133 _initial_elevation_ft(aPos.getElevationFt())
138 //------------------------------------------------------------------------------
139 const SGGeod& FGMobileNavRecord::geod() const
141 const_cast<FGMobileNavRecord*>(this)->updatePos();
142 return FGNavRecord::geod();
145 //------------------------------------------------------------------------------
146 const SGVec3d& FGMobileNavRecord::cart() const
148 const_cast<FGMobileNavRecord*>(this)->updatePos();
149 return FGNavRecord::cart();
152 //------------------------------------------------------------------------------
153 void FGMobileNavRecord::updateVehicle()
155 _vehicle_node.clear();
157 SGPropertyNode* ai_branch = fgGetNode("ai/models");
162 "Can not update mobile navaid position (no ai/models branch)" );
166 const std::string& nav_name = name();
168 // Try any aircraft carriers first
169 simgear::PropertyList carrier = ai_branch->getChildren("carrier");
170 for(size_t i = 0; i < carrier.size(); ++i)
172 const std::string carrier_name = carrier[i]->getStringValue("name");
174 if( carrier_name.empty()
175 || nav_name.find(carrier_name) == std::string::npos )
178 _vehicle_node = carrier[i];
183 const std::string tanker_branches[] = {
186 // And finally mp tankers
190 for(size_t i = 0; i < sizeof(tanker_branches)/sizeof(tanker_branches[0]); ++i)
192 simgear::PropertyList tanker = ai_branch->getChildren(tanker_branches[i]);
193 for(size_t j = 0; j < tanker.size(); ++j)
195 const std::string callsign = tanker[j]->getStringValue("callsign");
198 || nav_name.find(callsign) == std::string::npos )
201 _vehicle_node = tanker[j];
207 //------------------------------------------------------------------------------
208 void FGMobileNavRecord::updatePos()
210 SGTimeStamp now = SGTimeStamp::now();
211 if( (now - _last_vehicle_update).toSecs() > (_vehicle_node.valid() ? 5 : 2) )
214 _last_vehicle_update = now;
217 if( _vehicle_node.valid() )
218 modifyPosition(SGGeod::fromDegFt(
219 _vehicle_node->getDoubleValue("position/longitude-deg"),
220 _vehicle_node->getDoubleValue("position/latitude-deg"),
221 _vehicle_node->getNameString() == "carrier"
222 ? _initial_elevation_ft
223 : _vehicle_node->getDoubleValue("position/altitude-ft")
226 invalidatePosition();
228 serviceable = _vehicle_node.valid();
231 //------------------------------------------------------------------------------
232 FGTACANRecord::FGTACANRecord(void) :
240 operator >> ( std::istream& in, FGTACANRecord& n )
242 in >> n.channel >> n.freq ;
243 //getline( in, n.name );