#include <Navaids/navrecord.hxx>
#include <Navaids/navdb.hxx>
#include <Airports/runways.hxx>
-#include <Airports/simple.hxx>
+#include <Airports/airport.hxx>
#include <Airports/xmlloader.hxx>
-
#include <Main/fg_props.hxx>
-#include <Navaids/PositionedBinding.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),
+ mName(aName),
+ mRunway(aRunway),
+ mColocated(0),
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_DEBUG, "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;
- }
- }
-
- init(true); // init FGPositioned (now position is adjusted)
-}
-
-void FGNavRecord::initAirportRelation()
-{
- if ((type() < ILS) || (type() > GS)) {
- return; // not airport-located
- }
-
- 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(mRunway->elevation());
- }
-
- if (type() == ILS || type() == LOC) {
- 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);
- }
}
-void FGNavRecord::processSceneryILS(SGPropertyNode* aILSNode)
+FGRunwayRef FGNavRecord::runway() const
{
- 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
- double dist = SGGeodesy::distanceM(mPosition, mRunway->threshold());
-
-// back project that distance along the runway center line
- SGGeod newPos = mRunway->pointOnCenterline(dist);
-
- double hdg_diff = get_multiuse() - mRunway->headingDeg();
- SG_NORMALIZE_RANGE(hdg_diff, -180.0, 180.0);
-
- if ( fabs(hdg_diff) <= aThreshold ) {
- mPosition = SGGeod::fromGeodFt(newPos, mPosition.getElevationFt());
- set_multiuse( mRunway->headingDeg() );
- } else {
- SG_LOG(SG_GENERAL, SG_DEBUG, "localizer:" << ident() << ", aligning with runway "
- << mRunway->ident() << " exceeded heading threshold");
- }
+ return loadById<FGRunway>(mRunway);
}
double FGNavRecord::localizerWidth() const
return 6.0;
}
- SGVec3d thresholdCart(SGVec3d::fromGeod(mRunway->threshold()));
+ FGRunway* rwy = runway();
+ SGVec3d thresholdCart(SGVec3d::fromGeod(rwy->threshold()));
double axisLength = dist(cart(), thresholdCart);
- double landingLength = dist(thresholdCart, SGVec3d::fromGeod(mRunway->end()));
+ double landingLength = dist(thresholdCart, SGVec3d::fromGeod(rwy->end()));
// Reference: http://dcaa.slv.dk:8000/icaodocs/
// ICAO standard width at threshold is 210 m = 689 feet = approx 700 feet.
}
-flightgear::PositionedBinding*
-FGNavRecord::createBinding(SGPropertyNode* nd) const
+bool FGNavRecord::hasDME()
+{
+ return (mColocated > 0);
+}
+
+void FGNavRecord::setColocatedDME(PositionedID other)
+{
+ mColocated = other;
+}
+
+void FGNavRecord::updateFromXML(const SGGeod& geod, double heading)
+{
+ modifyPosition(geod);
+ multiuse = heading;
+}
+
+//------------------------------------------------------------------------------
+FGMobileNavRecord::FGMobileNavRecord( PositionedID aGuid,
+ Type type,
+ const std::string& ident,
+ const std::string& name,
+ const SGGeod& aPos,
+ int freq,
+ int range,
+ double multiuse,
+ PositionedID aRunway ):
+ FGNavRecord(aGuid, type, ident, name, aPos, freq, range, multiuse, aRunway),
+ _initial_elevation_ft(aPos.getElevationFt())
+{
+
+}
+
+//------------------------------------------------------------------------------
+const SGGeod& FGMobileNavRecord::geod() const
+{
+ const_cast<FGMobileNavRecord*>(this)->updatePos();
+ return FGNavRecord::geod();
+}
+
+//------------------------------------------------------------------------------
+const SGVec3d& FGMobileNavRecord::cart() const
+{
+ const_cast<FGMobileNavRecord*>(this)->updatePos();
+ return FGNavRecord::cart();
+}
+
+//------------------------------------------------------------------------------
+void FGMobileNavRecord::updateVehicle()
{
- return new flightgear::NavaidBinding(this, nd);
+ _vehicle_node.clear();
+
+ SGPropertyNode* ai_branch = fgGetNode("ai/models");
+ if( !ai_branch )
+ {
+ SG_LOG( SG_NAVAID,
+ SG_INFO,
+ "Can not update mobile navaid position (no ai/models branch)" );
+ return;
+ }
+
+ const std::string& nav_name = name();
+
+ // Try any aircraft carriers first
+ simgear::PropertyList carrier = ai_branch->getChildren("carrier");
+ for(size_t i = 0; i < carrier.size(); ++i)
+ {
+ const std::string carrier_name = carrier[i]->getStringValue("name");
+
+ if( carrier_name.empty()
+ || nav_name.find(carrier_name) == std::string::npos )
+ continue;
+
+ _vehicle_node = carrier[i];
+ return;
+ }
+
+ // Now the tankers
+ const std::string tanker_branches[] = {
+ // AI tankers
+ "tanker",
+ // And finally mp tankers
+ "multiplayer"
+ };
+
+ for(size_t i = 0; i < sizeof(tanker_branches)/sizeof(tanker_branches[0]); ++i)
+ {
+ simgear::PropertyList tanker = ai_branch->getChildren(tanker_branches[i]);
+ for(size_t j = 0; j < tanker.size(); ++j)
+ {
+ const std::string callsign = tanker[j]->getStringValue("callsign");
+
+ if( callsign.empty()
+ || nav_name.find(callsign) == std::string::npos )
+ continue;
+
+ _vehicle_node = tanker[j];
+ return;
+ }
+ }
}
+//------------------------------------------------------------------------------
+void FGMobileNavRecord::updatePos()
+{
+ SGTimeStamp now = SGTimeStamp::now();
+ if( (now - _last_vehicle_update).toSecs() > (_vehicle_node.valid() ? 5 : 2) )
+ {
+ updateVehicle();
+ _last_vehicle_update = now;
+ }
+
+ if( _vehicle_node.valid() )
+ modifyPosition(SGGeod::fromDegFt(
+ _vehicle_node->getDoubleValue("position/longitude-deg"),
+ _vehicle_node->getDoubleValue("position/latitude-deg"),
+ _vehicle_node->getNameString() == "carrier"
+ ? _initial_elevation_ft
+ : _vehicle_node->getDoubleValue("position/altitude-ft")
+ ));
+ else
+ invalidatePosition();
+
+ serviceable = _vehicle_node.valid();
+}
+//------------------------------------------------------------------------------
FGTACANRecord::FGTACANRecord(void) :
channel(""),
freq(0)