+// This program is free software; you can redistribute it and/or
+// modify it under the terms of the GNU General Public License as
+// published by the Free Software Foundation; either version 2 of the
+// License, or (at your option) any later version.
+//
+// This program is distributed in the hope that it will be useful, but
+// WITHOUT ANY WARRANTY; without even the implied warranty of
+// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+// General Public License for more details.
+//
+// You should have received a copy of the GNU General Public License
+// along with this program; if not, write to the Free Software
+// Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
+//
+
+#ifdef HAVE_CONFIG_H
+# include <config.h>
+#endif
+
+#include <cstdlib>
+#include <cstring> // for strcmp
+#include <boost/foreach.hpp>
+
#include "dynamicloader.hxx"
+#include <Navaids/NavDataCache.hxx>
+#include <Airports/dynamics.hxx>
+#include <Airports/airport.hxx>
+
+using std::string;
+
+/*****************************************************************************
+ * Helper function for parsing position string
+ ****************************************************************************/
+static double processPosition(const string &pos)
+{
+ string prefix;
+ string subs;
+ string degree;
+ string decimal;
+ int sign = 1;
+ double value;
+ subs = pos;
+ prefix= subs.substr(0,1);
+ if (prefix == string("S") || (prefix == string("W")))
+ sign = -1;
+ subs = subs.substr(1, subs.length());
+ degree = subs.substr(0, subs.find(" ",0));
+ decimal = subs.substr(subs.find(" ",0), subs.length());
+
+ value = sign * (atof(degree.c_str()) + atof(decimal.c_str())/60.0);
+ return value;
+}
+
FGAirportDynamicsXMLLoader::FGAirportDynamicsXMLLoader(FGAirportDynamics* dyn):
- XMLVisitor(), _dynamics(dyn) {}
+ XMLVisitor(), _dynamics(dyn)
+{}
void FGAirportDynamicsXMLLoader::startXML () {
- //cout << "Start XML" << endl;
+ //cout << "FGAirportDynamicsLoader::Start XML" << endl;
}
-void FGAirportDynamicsXMLLoader::endXML () {
- //cout << "End XML" << endl;
+void FGAirportDynamicsXMLLoader::endXML ()
+{
+ std::map<PositionedID, int>::iterator it;
+ flightgear::NavDataCache* cache = flightgear::NavDataCache::instance();
+
+ for (it = _parkingPushbacks.begin(); it != _parkingPushbacks.end(); ++it) {
+ std::map<int, PositionedID>::iterator j = _idMap.find(it->second);
+ if (j == _idMap.end()) {
+ SG_LOG(SG_NAVAID, SG_WARN, "bad groundnet, no node for index:" << it->first);
+ continue;
+ }
+
+ cache->setParkingPushBackRoute(it->first, j->second);
+ }
+
+ BOOST_FOREACH(PositionedID id, _unreferencedNodes) {
+ SG_LOG(SG_NAVAID, SG_WARN, "unreferenced groundnet node:" << id);
+ }
+
}
-void FGAirportDynamicsXMLLoader::startElement (const char * name, const XMLAttributes &atts) {
- // const char *attval;
- FGParking park;
- FGTaxiNode taxiNode;
- FGTaxiSegment taxiSegment;
+void FGAirportDynamicsXMLLoader::startParking(const XMLAttributes &atts)
+{
+ string type;
int index = 0;
- taxiSegment.setIndex(index);
- //cout << "Start element " << name << endl;
- string attname;
- string value;
- string gateName;
- string gateNumber;
- string lat;
- string lon;
- if (name == string("Parking"))
- {
- for (int i = 0; i < atts.size(); i++)
+ string gateName, gateNumber;
+ string lat, lon;
+ double heading = 0.0;
+ double radius = 1.0;
+ string airlineCodes;
+ int pushBackRoute = 0;
+
+ for (int i = 0; i < atts.size(); i++)
{
- //cout << " " << atts.getName(i) << '=' << atts.getValue(i) << endl;
- attname = atts.getName(i);
- if (attname == string("index"))
- park.setIndex(atoi(atts.getValue(i)));
- else if (attname == string("type"))
- park.setType(atts.getValue(i));
- else if (attname == string("name"))
- gateName = atts.getValue(i);
- else if (attname == string("number"))
+ string attname(atts.getName(i));
+ if (attname == "index") {
+ index = std::atoi(atts.getValue(i));
+ } else if (attname == "type")
+ type = atts.getValue(i);
+ else if (attname == "name")
+ gateName = atts.getValue(i);
+ else if (attname == "number")
gateNumber = atts.getValue(i);
- else if (attname == string("lat"))
- park.setLatitude(atts.getValue(i));
- else if (attname == string("lon"))
- park.setLongitude(atts.getValue(i));
- else if (attname == string("heading"))
- park.setHeading(atof(atts.getValue(i)));
- else if (attname == string("radius")) {
- string radius = atts.getValue(i);
- if (radius.find("M") != string::npos)
- radius = radius.substr(0, radius.find("M",0));
- //cerr << "Radius " << radius <<endl;
- park.setRadius(atof(radius.c_str()));
+ else if (attname == "lat")
+ lat = atts.getValue(i);
+ else if (attname == "lon")
+ lon = atts.getValue(i);
+ else if (attname == "heading")
+ heading = std::atof(atts.getValue(i));
+ else if (attname == "radius") {
+ string radiusStr = atts.getValue(i);
+ if (radiusStr.find("M") != string::npos)
+ radiusStr = radiusStr.substr(0, radiusStr.find("M",0));
+ radius = std::atof(radiusStr.c_str());
}
- else if (attname == string("airlineCodes"))
- park.setCodes(atts.getValue(i));
- }
- park.setName((gateName+gateNumber));
- _dynamics->addParking(park);
+ else if (attname == "airlineCodes")
+ airlineCodes = atts.getValue(i);
+ else if (attname == "pushBackRoute") {
+ pushBackRoute = std::atoi(atts.getValue(i));
}
- if (name == string("node"))
- {
- for (int i = 0; i < atts.size() ; i++)
- {
- attname = atts.getName(i);
- if (attname == string("index"))
- taxiNode.setIndex(atoi(atts.getValue(i)));
- if (attname == string("lat"))
- taxiNode.setLatitude(atts.getValue(i));
- if (attname == string("lon"))
- taxiNode.setLongitude(atts.getValue(i));
}
- _dynamics->getGroundNetwork()->addNode(taxiNode);
+
+ SGGeod pos(SGGeod::fromDeg(processPosition(lon), processPosition(lat)));
+
+ PositionedID guid = flightgear::NavDataCache::instance()->insertParking(gateName + gateNumber, pos,
+ _dynamics->parent()->guid(),
+ heading, radius, type, airlineCodes);
+ if (pushBackRoute > 0) {
+ _parkingPushbacks[guid] = pushBackRoute;
+ }
+
+ _idMap[index] = guid;
+}
+
+void FGAirportDynamicsXMLLoader::startNode(const XMLAttributes &atts)
+{
+ int index = 0;
+ string lat, lon;
+ bool onRunway = false;
+ int holdPointType = 0;
+
+ for (int i = 0; i < atts.size() ; i++)
+ {
+ string attname(atts.getName(i));
+ if (attname == "index")
+ index = std::atoi(atts.getValue(i));
+ else if (attname == "lat")
+ lat = atts.getValue(i);
+ else if (attname == "lon")
+ lon = atts.getValue(i);
+ else if (attname == "isOnRunway")
+ onRunway = std::atoi(atts.getValue(i)) != 0;
+ else if (attname == "holdPointType") {
+ string attval = atts.getValue(i);
+ if (attval=="none") {
+ holdPointType=0;
+ } else if (attval=="normal") {
+ holdPointType=1;
+ } else if (attval=="CAT II/III") {
+ holdPointType=3;
+ } else if (attval=="PushBack") {
+ holdPointType=3;
+ } else {
+ holdPointType=0;
+ }
}
- if (name == string("arc"))
- {
- taxiSegment.setIndex(++index);
- for (int i = 0; i < atts.size() ; i++)
+ }
+
+ if (_idMap.find(index) != _idMap.end()) {
+ SG_LOG(SG_NAVAID, SG_WARN, "duplicate ground-net index:" << index);
+ }
+
+ SGGeod pos(SGGeod::fromDeg(processPosition(lon), processPosition(lat)));
+ PositionedID guid = flightgear::NavDataCache::instance()->insertTaxiNode(pos,
+ _dynamics->parent()->guid(), holdPointType, onRunway);
+ _idMap[index] = guid;
+ _unreferencedNodes.insert(guid);
+}
+
+void FGAirportDynamicsXMLLoader::startArc(const XMLAttributes &atts)
+{
+ int begin = 0, end = 0;
+ bool isPushBackRoute = false;
+
+ for (int i = 0; i < atts.size() ; i++)
{
- attname = atts.getName(i);
- if (attname == string("begin"))
- taxiSegment.setStartNodeRef(atoi(atts.getValue(i)));
- if (attname == string("end"))
- taxiSegment.setEndNodeRef(atoi(atts.getValue(i)));
+ string attname = atts.getName(i);
+ if (attname == "begin")
+ begin = std::atoi(atts.getValue(i));
+ else if (attname == "end")
+ end = std::atoi(atts.getValue(i));
+ else if (attname == "isPushBackRoute")
+ isPushBackRoute = std::atoi(atts.getValue(i)) != 0;
}
- _dynamics->getGroundNetwork()->addSegment(taxiSegment);
- }
- // sort by radius, in asending order, so that smaller gates are first in the list
+
+ IntPair e(begin, end);
+ if (_arcSet.find(e) != _arcSet.end()) {
+ SG_LOG(SG_NAVAID, SG_WARN, _dynamics->parent()->ident() << " ground-net: skipping duplicate edge:" << begin << "->" << end);
+ return;
+ }
+
+ _arcSet.insert(e);
+ flightgear::NavDataCache::instance()->insertGroundnetEdge(_dynamics->parent()->guid(),
+ _idMap[begin], _idMap[end]);
+
+ _unreferencedNodes.erase(_idMap[begin]);
+ _unreferencedNodes.erase(_idMap[end]);
+
+ if (isPushBackRoute) {
+ flightgear::NavDataCache::instance()->markGroundnetAsPushback(_idMap[end]);
+ }
}
-void FGAirportDynamicsXMLLoader::endElement (const char * name) {
- //cout << "End element " << name << endl;
+void FGAirportDynamicsXMLLoader::startElement (const char * name, const XMLAttributes &atts)
+{
+ if (!strcmp("Parking", name)) {
+ startParking(atts);
+ } else if (!strcmp("node", name)) {
+ startNode(atts);
+ } else if (!strcmp("arc", name)) {
+ startArc(atts);
+ }
+}
+void FGAirportDynamicsXMLLoader::endElement (const char * name)
+{
+ int valueAsInt = atoi(value.c_str());
+ if (!strcmp("version", name)) {
+ _dynamics->getGroundNetwork()->addVersion(valueAsInt);
+ } else if (!strcmp("AWOS", name)) {
+ _dynamics->addAwosFreq(valueAsInt);
+ } else if (!strcmp("UNICOM", name)) {
+ _dynamics->addUnicomFreq(valueAsInt);
+ } else if (!strcmp("CLEARANCE", name)) {
+ _dynamics->addClearanceFreq(valueAsInt);
+ } else if (!strcmp("GROUND", name)) {
+ _dynamics->addGroundFreq(valueAsInt);
+ } else if (!strcmp("TOWER", name)) {
+ _dynamics->addTowerFreq(valueAsInt);
+ } else if (!strcmp("APPROACH", name)) {
+ _dynamics->addApproachFreq(valueAsInt);
+ }
}
void FGAirportDynamicsXMLLoader::data (const char * s, int len) {
string token = string(s,len);
//cout << "Character data " << string(s,len) << endl;
- //if ((token.find(" ") == string::npos && (token.find('\n')) == string::npos))
- //value += token;
- //else
- //value = string("");
+ if ((token.find(" ") == string::npos && (token.find('\n')) == string::npos))
+ value += token;
+ else
+ value = string("");
}
void FGAirportDynamicsXMLLoader::pi (const char * target, const char * data) {
projects / flightgear.git / blobdiff