src/Navaids/navrecord.cxx

   1 // navrecord.cxx -- generic vor/dme/ndb class
   2 //
   3 // Written by Curtis Olson, started May 2004.
   4 //
   5 // Copyright (C) 2004  Curtis L. Olson - http://www.flightgear.org/~curt
   6 //
   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.
  11 //
  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.
  16 //
  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.
  20 //
  21 // $Id$
  22
  23 #ifdef HAVE_CONFIG_H
  24   #include "config.h"
  25 #endif
  26
  27 #include <istream>
  28
  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
  36
  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>
  43
  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),
  48   freq(aFreq),
  49   range(aRange),
  50   multiuse(aMultiuse),
  51   mName(aName),
  52   mRunway(aRunway),
  53   mColocated(0),
  54   serviceable(true)
  55 {
  56 }
  57
  58 FGRunwayRef FGNavRecord::runway() const
  59 {
  60   return loadById<FGRunway>(mRunway);
  61 }
  62
  63 double FGNavRecord::localizerWidth() const
  64 {
  65   if (!mRunway) {
  66     return 6.0;
  67   }
  68
  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()));
  73
  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."
  80
  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.
  85     axisLength += 1050.0;
  86   }
  87
  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;
  93
  94 }
  95
  96 bool FGNavRecord::hasDME()
  97 {
  98   return (mColocated > 0);
  99 }
 100
 101 void FGNavRecord::setColocatedDME(PositionedID other)
 102 {
 103   mColocated = other;
 104 }
 105
 106 void FGNavRecord::updateFromXML(const SGGeod& geod, double heading)
 107 {
 108     modifyPosition(geod);
 109     multiuse = heading;
 110 }
 111
 112 //------------------------------------------------------------------------------
 113 FGMobileNavRecord::FGMobileNavRecord( PositionedID aGuid,
 114                                       Type type,
 115                                       const std::string& ident,
 116                                       const std::string& name,
 117                                       const SGGeod& aPos,
 118                                       int freq,
 119                                       int range,
 120                                       double multiuse,
 121                                       PositionedID aRunway ):
 122   FGNavRecord(aGuid, type, ident, name, aPos, freq, range, multiuse, aRunway),
 123   _initial_elevation_ft(aPos.getElevationFt())
 124 {
 125
 126 }
 127
 128 //------------------------------------------------------------------------------
 129 const SGGeod& FGMobileNavRecord::geod() const
 130 {
 131   const_cast<FGMobileNavRecord*>(this)->updatePos();
 132   return FGNavRecord::geod();
 133 }
 134
 135 //------------------------------------------------------------------------------
 136 const SGVec3d& FGMobileNavRecord::cart() const
 137 {
 138   const_cast<FGMobileNavRecord*>(this)->updatePos();
 139   return FGNavRecord::cart();
 140 }
 141
 142 //------------------------------------------------------------------------------
 143 void FGMobileNavRecord::updateVehicle()
 144 {
 145   _vehicle_node.clear();
 146
 147   SGPropertyNode* ai_branch = fgGetNode("ai/models");
 148   if( !ai_branch )
 149   {
 150     SG_LOG( SG_NAVAID,
 151             SG_INFO,
 152             "Can not update mobile navaid position (no ai/models branch)" );
 153     return;
 154   }
 155
 156   const std::string& nav_name = name();
 157
 158   // Try any aircraft carriers first
 159   simgear::PropertyList carrier = ai_branch->getChildren("carrier");
 160   for(size_t i = 0; i < carrier.size(); ++i)
 161   {
 162     const std::string carrier_name = carrier[i]->getStringValue("name");
 163
 164     if(    carrier_name.empty()
 165         || nav_name.find(carrier_name) == std::string::npos )
 166       continue;
 167
 168     _vehicle_node = carrier[i];
 169     return;
 170   }
 171
 172   // Now the tankers
 173   const std::string tanker_branches[] = {
 174     // AI tankers
 175     "tanker",
 176     // And finally mp tankers
 177     "multiplayer"
 178   };
 179
 180   for(size_t i = 0; i < sizeof(tanker_branches)/sizeof(tanker_branches[0]); ++i)
 181   {
 182     simgear::PropertyList tanker = ai_branch->getChildren(tanker_branches[i]);
 183     for(size_t j = 0; j < tanker.size(); ++j)
 184     {
 185       const std::string callsign = tanker[j]->getStringValue("callsign");
 186
 187       if(    callsign.empty()
 188           || nav_name.find(callsign) == std::string::npos )
 189         continue;
 190
 191       _vehicle_node = tanker[j];
 192       return;
 193     }
 194   }
 195 }
 196
 197 //------------------------------------------------------------------------------
 198 void FGMobileNavRecord::updatePos()
 199 {
 200   SGTimeStamp now = SGTimeStamp::now();
 201   if( (now - _last_vehicle_update).toSecs() > (_vehicle_node.valid() ? 5 : 2) )
 202   {
 203     updateVehicle();
 204     _last_vehicle_update = now;
 205   }
 206
 207   if( _vehicle_node.valid() )
 208     modifyPosition(SGGeod::fromDegFt(
 209       _vehicle_node->getDoubleValue("position/longitude-deg"),
 210       _vehicle_node->getDoubleValue("position/latitude-deg"),
 211       _vehicle_node->getNameString() == "carrier"
 212       ? _initial_elevation_ft
 213       : _vehicle_node->getDoubleValue("position/altitude-ft")
 214     ));
 215   else
 216     invalidatePosition();
 217
 218   serviceable = _vehicle_node.valid();
 219 }
 220
 221 //------------------------------------------------------------------------------
 222 FGTACANRecord::FGTACANRecord(void) :
 223     channel(""),
 224     freq(0)
 225
 226 {
 227 }
 228
 229 std::istream&
 230 operator >> ( std::istream& in, FGTACANRecord& n )
 231 {
 232     in >> n.channel >> n.freq ;
 233     //getline( in, n.name );
 234
 235     return in;
 236 }