#ifndef _GROUNDNETWORK_HXX_
#define _GROUNDNETWORK_HXX_
+#include <osg/Geode>
+#include <osg/Geometry>
+#include <osg/MatrixTransform>
+#include <osg/Shape>
+
+
#include <simgear/compiler.h>
#include <simgear/route/waypoint.hxx>
#include <string>
#include <vector>
+#include <list>
+class Block;
using std::string;
using std::vector;
+using std::list;
#include "gnnode.hxx"
#include "parking.hxx"
#include <ATC/trafficcontrol.hxx>
+
class FGTaxiSegment; // forward reference
class FGAIFlightPlan; // forward reference
class FGAirport; // forward reference
//typedef vector<FGTaxiSegment*> FGTaxiSegmentPointerVector;
//typedef vector<FGTaxiSegment*>::iterator FGTaxiSegmentPointerVectorIterator;
+class Block
+{
+private:
+ int id;
+ time_t blocktime;
+ time_t touch;
+public:
+ Block(int i, time_t bt, time_t curr) { id = i; blocktime= bt; touch = curr; };
+ ~Block() {};
+ int getId() { return id; };
+ void updateTimeStamps(time_t bt, time_t now) { blocktime = (bt < blocktime) ? bt : blocktime; touch = now; };
+ const time_t getBlockTime() const { return blocktime; };
+ time_t getTimeStamp() { return touch; };
+ bool operator< (const Block &other) const { return blocktime < other.blocktime; };
+};
+
+typedef vector<Block> BlockList;
+typedef BlockList::iterator BlockListIterator;
+
/***************************************************************************************
* class FGTaxiSegment
**************************************************************************************/
class FGTaxiSegment
{
private:
- int startNode;
- int endNode;
- double length;
- double course;
- double headingDiff;
- bool isActive;
- bool isPushBackRoute;
- FGTaxiNode *start;
- FGTaxiNode *end;
- int index;
- FGTaxiSegment *oppositeDirection;
-
-
+ int startNode;
+ int endNode;
+ double length;
+ double heading;
+ SGGeod center;
+ bool isActive;
+ bool isPushBackRoute;
+ BlockList blockTimes;
+ FGTaxiNode *start;
+ FGTaxiNode *end;
+ int index;
+ FGTaxiSegment *oppositeDirection;
+
+
public:
- FGTaxiSegment() :
- startNode(0),
- endNode(0),
- length(0),
- course(0),
- headingDiff(0),
- isActive(0),
- isPushBackRoute(0),
- start(0),
- end(0),
- index(0),
- oppositeDirection(0)
- {
- };
-
- FGTaxiSegment (const FGTaxiSegment &other) :
- startNode (other.startNode),
- endNode (other.endNode),
- length (other.length),
- course (other.course),
- headingDiff (other.headingDiff),
- isActive (other.isActive),
- isPushBackRoute (other.isPushBackRoute),
- start (other.start),
- end (other.end),
- index (other.index),
- oppositeDirection (other.oppositeDirection)
- {
- };
-
- FGTaxiSegment& operator=(const FGTaxiSegment &other)
- {
- startNode = other.startNode;
- endNode = other.endNode;
- length = other.length;
- course = other.course;
- headingDiff = other.headingDiff;
- isActive = other.isActive;
- isPushBackRoute = other.isPushBackRoute;
- start = other.start;
- end = other.end;
- index = other.index;
- oppositeDirection = other.oppositeDirection;
- return *this;
- };
-
- void setIndex (int val) { index = val; };
- void setStartNodeRef (int val) { startNode = val; };
- void setEndNodeRef (int val) { endNode = val; };
-
- void setOpposite(FGTaxiSegment *opp) { oppositeDirection = opp; };
-
- void setStart(FGTaxiNodeVector *nodes);
- void setEnd (FGTaxiNodeVector *nodes);
- void setPushBackType(bool val) { isPushBackRoute = val; };
- void setTrackDistance();
-
- FGTaxiNode * getEnd() { return end;};
- FGTaxiNode * getStart() { return start; };
- double getLength() { return length; };
- int getIndex() { return index; };
-
- bool isPushBack() { return isPushBackRoute; };
-
- int getPenalty(int nGates);
-
- FGTaxiSegment *getAddress() { return this;};
-
- bool operator<(const FGTaxiSegment &other) const { return index < other.index; };
- bool hasSmallerHeadingDiff (const FGTaxiSegment &other) const { return headingDiff < other.headingDiff; };
- FGTaxiSegment *opposite() { return oppositeDirection; };
- void setCourseDiff(double crse);
-
-
-
+ FGTaxiSegment() :
+ startNode(0),
+ endNode(0),
+ length(0),
+ heading(0),
+ isActive(0),
+ isPushBackRoute(0),
+ start(0),
+ end(0),
+ index(0),
+ oppositeDirection(0)
+ {
+ };
+
+ FGTaxiSegment (const FGTaxiSegment &other) :
+ startNode (other.startNode),
+ endNode (other.endNode),
+ length (other.length),
+ heading (other.heading),
+ center (other.center),
+ isActive (other.isActive),
+ isPushBackRoute (other.isPushBackRoute),
+ blockTimes (other.blockTimes),
+ start (other.start),
+ end (other.end),
+ index (other.index),
+ oppositeDirection (other.oppositeDirection)
+ {
+ };
+
+ FGTaxiSegment& operator=(const FGTaxiSegment &other)
+ {
+ startNode = other.startNode;
+ endNode = other.endNode;
+ length = other.length;
+ heading = other.heading;
+ center = other.center;
+ isActive = other.isActive;
+ isPushBackRoute = other.isPushBackRoute;
+ blockTimes = other.blockTimes;
+ start = other.start;
+ end = other.end;
+ index = other.index;
+ oppositeDirection = other.oppositeDirection;
+ return *this;
+ };
+
+ void setIndex (int val) {
+ index = val;
+ };
+ void setStartNodeRef (int val) {
+ startNode = val;
+ };
+ void setEndNodeRef (int val) {
+ endNode = val;
+ };
+
+ void setOpposite(FGTaxiSegment *opp) {
+ oppositeDirection = opp;
+ };
+
+ void setStart(FGTaxiNodeVector *nodes);
+ void setEnd (FGTaxiNodeVector *nodes);
+ void setPushBackType(bool val) {
+ isPushBackRoute = val;
+ };
+ void setDimensions(double elevation);
+ void block(int id, time_t blockTime, time_t now);
+ void unblock(time_t now);
+ bool hasBlock(time_t now);
+
+ FGTaxiNode * getEnd() {
+ return end;
+ };
+ FGTaxiNode * getStart() {
+ return start;
+ };
+ double getLength() {
+ return length;
+ };
+ int getIndex() {
+ return index;
+ };
+ double getLatitude() {
+ return center.getLatitudeDeg();
+ };
+ double getLongitude() {
+ return center.getLongitudeDeg();
+ };
+ double getHeading() {
+ return heading;
+ };
+ bool isPushBack() {
+ return isPushBackRoute;
+ };
+
+ int getPenalty(int nGates);
+
+ FGTaxiSegment *getAddress() {
+ return this;
+ };
+
+ bool operator<(const FGTaxiSegment &other) const {
+ return index < other.index;
+ };
+ //bool hasSmallerHeadingDiff (const FGTaxiSegment &other) const { return headingDiff < other.headingDiff; };
+ FGTaxiSegment *opposite() {
+ return oppositeDirection;
+ };
+ void setCourseDiff(double crse);
+
+
+
+
};
class FGTaxiRoute
{
private:
- intVec nodes;
- intVec routes;
- double distance;
- int depth;
- intVecIterator currNode;
- intVecIterator currRoute;
+ intVec nodes;
+ intVec routes;
+ double distance;
+// int depth;
+ intVecIterator currNode;
+ intVecIterator currRoute;
public:
- FGTaxiRoute() { distance = 0; currNode = nodes.begin(); currRoute = routes.begin();};
- FGTaxiRoute(intVec nds, intVec rts, double dist, int dpth) {
- nodes = nds;
- routes = rts;
- distance = dist;
- currNode = nodes.begin();
- depth = dpth;
- };
-
- FGTaxiRoute& operator= (const FGTaxiRoute &other) {
- nodes = other.nodes;
- routes = other.routes;
- distance = other.distance;
- depth = other.depth;
- currNode = nodes.begin();
- currRoute = routes.begin();
- return *this;
- };
-
- FGTaxiRoute(const FGTaxiRoute& copy) :
- nodes(copy.nodes),
- routes(copy.routes),
- distance(copy.distance),
- depth(copy.depth),
- currNode(nodes.begin()),
- currRoute(routes.begin())
- {};
-
- bool operator< (const FGTaxiRoute &other) const {return distance < other.distance; };
- bool empty () { return nodes.begin() == nodes.end(); };
- bool next(int *nde);
- bool next(int *nde, int *rte);
- void rewind(int legNr);
-
- void first() { currNode = nodes.begin(); currRoute = routes.begin(); };
- int size() { return nodes.size(); };
- int getDepth() { return depth; };
+ FGTaxiRoute() {
+ distance = 0;
+ currNode = nodes.begin();
+ currRoute = routes.begin();
+ };
+ FGTaxiRoute(intVec nds, intVec rts, double dist, int dpth) {
+ nodes = nds;
+ routes = rts;
+ distance = dist;
+ currNode = nodes.begin();
+ currRoute = routes.begin();
+// depth = dpth;
+ };
+
+ FGTaxiRoute& operator= (const FGTaxiRoute &other) {
+ nodes = other.nodes;
+ routes = other.routes;
+ distance = other.distance;
+// depth = other.depth;
+ currNode = nodes.begin();
+ currRoute = routes.begin();
+ return *this;
+ };
+
+ FGTaxiRoute(const FGTaxiRoute& copy) :
+ nodes(copy.nodes),
+ routes(copy.routes),
+ distance(copy.distance),
+// depth(copy.depth),
+ currNode(nodes.begin()),
+ currRoute(routes.begin())
+ {};
+
+ bool operator< (const FGTaxiRoute &other) const {
+ return distance < other.distance;
+ };
+ bool empty () {
+ return nodes.begin() == nodes.end();
+ };
+ bool next(int *nde);
+ bool next(int *nde, int *rte);
+ void rewind(int legNr);
+
+ void first() {
+ currNode = nodes.begin();
+ currRoute = routes.begin();
+ };
+ int size() {
+ return nodes.size();
+ };
+ int nodesLeft() {
+ return nodes.end() - currNode;
+ };
+
+// int getDepth() { return depth; };
};
typedef vector<FGTaxiRoute> TaxiRouteVector;
class FGGroundNetwork : public FGATCController
{
private:
- bool hasNetwork;
- //int maxDepth;
- int count;
- FGTaxiNodeVector nodes;
- FGTaxiNodeVector pushBackNodes;
- FGTaxiSegmentVector segments;
- //intVec route;
- //intVec nodesStack;
- //intVec routesStack;
- TaxiRouteVector routes;
- TrafficVector activeTraffic;
- TrafficVectorIterator currTraffic;
- SGWayPoint destination;
-
- bool foundRoute;
- double totalDistance, maxDistance;
- FGTowerController *towerController;
- FGAirport *parent;
-
-
- //void printRoutingError(string);
-
- void checkSpeedAdjustment(int id, double lat, double lon,
- double heading, double speed, double alt);
- void checkHoldPosition(int id, double lat, double lon,
- double heading, double speed, double alt);
+ bool hasNetwork;
+ bool networkInitialized;
+ time_t nextSave;
+ //int maxDepth;
+ int count;
+ int version;
+ FGTaxiNodeVector nodes;
+ FGTaxiNodeVector pushBackNodes;
+ FGTaxiSegmentVector segments;
+ //intVec route;
+ //intVec nodesStack;
+ //intVec routesStack;
+ TaxiRouteVector routes;
+ TrafficVector activeTraffic;
+ TrafficVectorIterator currTraffic;
+
+ bool foundRoute;
+ double totalDistance, maxDistance;
+ FGTowerController *towerController;
+ FGAirport *parent;
+
+
+ //void printRoutingError(string);
+
+ void checkSpeedAdjustment(int id, double lat, double lon,
+ double heading, double speed, double alt);
+ void checkHoldPosition(int id, double lat, double lon,
+ double heading, double speed, double alt);
+
+
public:
- FGGroundNetwork();
- ~FGGroundNetwork();
-
- void addNode (const FGTaxiNode& node);
- void addNodes (FGParkingVec *parkings);
- void addSegment(const FGTaxiSegment& seg);
-
- void init();
- bool exists() { return hasNetwork; };
- void setTowerController(FGTowerController *twrCtrlr) { towerController = twrCtrlr; };
-
- int findNearestNode(double lat, double lon);
- int findNearestNode(const SGGeod& aGeod);
-
- FGTaxiNode *findNode(int idx);
- FGTaxiSegment *findSegment(int idx);
- FGTaxiRoute findShortestRoute(int start, int end, bool fullSearch=true);
- //void trace(FGTaxiNode *, int, int, double dist);
-
- int getNrOfNodes() { return nodes.size(); };
-
- void setParent(FGAirport *par) { parent = par; };
-
- virtual void announcePosition(int id, FGAIFlightPlan *intendedRoute, int currentRoute,
- double lat, double lon, double hdg, double spd, double alt,
- double radius, int leg, FGAIAircraft *aircraft);
- virtual void signOff(int id);
- virtual void update(int id, double lat, double lon, double heading, double speed, double alt, double dt);
- virtual bool hasInstruction(int id);
- virtual FGATCInstruction getInstruction(int id);
-
- bool checkForCircularWaits(int id);
+ FGGroundNetwork();
+ ~FGGroundNetwork();
+
+ void addNode (const FGTaxiNode& node);
+ void addNodes (FGParkingVec *parkings);
+ void addSegment(const FGTaxiSegment& seg);
+ void setVersion (int v) { version = v;};
+
+ int getVersion() { return version; };
+
+ void init();
+ bool exists() {
+ return hasNetwork;
+ };
+ void setTowerController(FGTowerController *twrCtrlr) {
+ towerController = twrCtrlr;
+ };
+
+ int findNearestNode(double lat, double lon);
+ int findNearestNode(const SGGeod& aGeod);
+ int findNearestNodeOnRunway(const SGGeod& aGeod);
+
+ FGTaxiNode *findNode(unsigned idx);
+ FGTaxiSegment *findSegment(unsigned idx);
+ FGTaxiRoute findShortestRoute(int start, int end, bool fullSearch=true);
+ //void trace(FGTaxiNode *, int, int, double dist);
+
+ int getNrOfNodes() {
+ return nodes.size();
+ };
+
+ void setParent(FGAirport *par) {
+ parent = par;
+ };
+
+ virtual void announcePosition(int id, FGAIFlightPlan *intendedRoute, int currentRoute,
+ double lat, double lon, double hdg, double spd, double alt,
+ double radius, int leg, FGAIAircraft *aircraft);
+ virtual void signOff(int id);
+ virtual void updateAircraftInformation(int id, double lat, double lon, double heading, double speed, double alt, double dt);
+ virtual bool hasInstruction(int id);
+ virtual FGATCInstruction getInstruction(int id);
+
+ bool checkTransmissionState(int minState, int MaxState, TrafficVectorIterator i, time_t now, AtcMsgId msgId,
+ AtcMsgDir msgDir);
+ bool checkForCircularWaits(int id);
+ virtual void render(bool);
+ virtual string getName();
+ virtual void update(double dt);
+
+ void saveElevationCache();
+ void addVersion(int v) {version = v; };
};