- pushBackRoute->first();
- while(pushBackRoute->next(&node, &rte))
- {
- //FGTaxiNode *tn = apt->getDynamics()->getGroundNetwork()->findSegment(node)->getEnd();
- char buffer[10];
- snprintf (buffer, 10, "%d", node);
- FGTaxiNode *tn = dep->getDynamics()->getGroundNetwork()->findNode(node);
- //ids.pop_back();
- //wpt = new waypoint;
- SGGeod coord = coord.fromDeg(tn->getLongitude(), tn->getLatitude());
- FGAIWaypoint *wpt = createOnGround(ac, string(buffer), coord, dep->getElevation(), vTaxiBackward);
-
- wpt->setRouteIndex(rte);
- waypoints.push_back(wpt);
- }
- // some special considerations for the last point:
- waypoints.back()->setName(string("PushBackPoint"));
- waypoints.back()->setSpeed(vTaxi);
- } else { // In case of a push forward departure...
- double lat2 = 0.0, lon2 = 0.0, az2 = 0.0;
-
- //cerr << "Creating final push forward point for gate " << gateId << endl;
- FGTaxiNode *tn = dep->getDynamics()->getGroundNetwork()->findNode(gateId);
- FGTaxiSegmentVectorIterator ts = tn->getBeginRoute();
- FGTaxiSegmentVectorIterator te = tn->getEndRoute();
- if (ts == te) {
- SG_LOG(SG_GENERAL, SG_ALERT, "Gate " << gateId << "doesn't seem to have routes associated with it.");
- //exit(1);
- }
- tn = (*ts)->getEnd();
- lastNodeVisited = tn->getIndex();
- if (tn == NULL) {
- SG_LOG(SG_GENERAL, SG_ALERT, "No valid taxinode found");
- exit(1);
- }
- double distance = (*ts)->getLength();
- cerr << "Length of push forward route = " << distance << " and heading is " << heading << endl;
- lat2 = tn->getLatitude();
- lon2 = tn->getLongitude();
-
- for (int i = 1; i < 10; i++) {
- geo_direct_wgs_84 ( 0, lat, lon, heading,
- ((i / 10.0) * distance), &lat2, &lon2, &az2 );
- char buffer[16];
- snprintf(buffer, 16, "pushback-%02d", i);
- SGGeod coord = coord.fromDeg(lon2, lat2);
- cerr << i << endl;
- FGAIWaypoint *wpt = createOnGround(ac, string(buffer), coord, dep->getElevation(), vTaxiReduced);
-
- wpt->setRouteIndex((*ts)->getIndex());
- waypoints.push_back(wpt);
- }
- cerr << "Done " << endl;
- waypoints.back()->setName(string("PushBackPoint"));
- cerr << "Done assinging new name" << endl;