From 53445c80d49eee88daac0466d4d4709d4f7dbbf8 Mon Sep 17 00:00:00 2001 From: Durk Talsma Date: Sat, 31 Dec 2011 18:16:38 +0100 Subject: [PATCH] Some commented out debugging code that may help us trace down bug 532. --- src/ATC/atc_mgr.cxx | 28 +++++++++++++++++++++------- 1 file changed, 21 insertions(+), 7 deletions(-) diff --git a/src/ATC/atc_mgr.cxx b/src/ATC/atc_mgr.cxx index 1a145556c..78328ee5e 100644 --- a/src/ATC/atc_mgr.cxx +++ b/src/ATC/atc_mgr.cxx @@ -188,20 +188,21 @@ void FGATCManager::update ( double time ) { FGAIFlightPlan *fp = ai_ac.GetFlightPlan(); /* test code : find out how the routing develops */ - if (fp) { + /*if (fp) { int size = fp->getNrOfWayPoints(); - // //cerr << "Setting pos" << pos << " "; - // //cerr << "setting intentions " ; + //cerr << "Setting pos" << pos << " "; + //cerr << "setting intentions " ; + cerr << "Size of waypoint cue " << size << " "; for (int i = 0; i < size; i++) { - // int val = fp->getRouteIndex(i); - //cerr << fp->getWayPoint(i)->getName() << " "; + int val = fp->getRouteIndex(i); + cerr << fp->getWayPoint(i)->getName() << " "; //if ((val) && (val != pos)) { //intentions.push_back(val); //cerr << "[done ] " << endl; //} } - } - //cerr << "[done ] " << endl; + cerr << "[done ] " << endl; + }*/ if (fp) { //cerr << "Currently at leg : " << fp->getLeg() << endl; } @@ -210,6 +211,19 @@ void FGATCManager::update ( double time ) { double heading = fgGetDouble("/orientation/heading-deg"); double speed = fgGetDouble("/velocities/groundspeed-kt"); double altitude = fgGetDouble("/position/altitude-ft"); + + SGGeod me(SGGeod::fromDegM(longitude, + latitude, + altitude)); + SGGeod wpt(SGGeod::fromDegM(fp->getWayPoint(1)->getLongitude(), + fp->getWayPoint(1)->getLatitude(), + fp->getWayPoint(1)->getAltitude())); + + double course, az2, dist; + SGGeodesy::inverse(me, wpt, course, az2, dist); + + cerr << "Bearing to nearest waypoint : " << course << endl; + ai_ac.setLatitude(latitude); ai_ac.setLongitude(longitude); ai_ac.setAltitude(altitude); -- 2.39.5