X-Git-Url: https://git.mxchange.org/?a=blobdiff_plain;f=src%2FAIModel%2FAIFlightPlan.cxx;h=13285885051d2d5ac6cef5515629e8673ed7f68e;hb=467513cbaf40a7e1bd4077d71b60eef6c881741a;hp=8f985ddcd28dece49a4cd1376125d843b2ab9d86;hpb=900fce637486f98b66cb5e4e17ee6bb641043952;p=flightgear.git diff --git a/src/AIModel/AIFlightPlan.cxx b/src/AIModel/AIFlightPlan.cxx index 8f985ddcd..132858850 100644 --- a/src/AIModel/AIFlightPlan.cxx +++ b/src/AIModel/AIFlightPlan.cxx @@ -187,8 +187,8 @@ FGAIFlightPlan::FGAIFlightPlan(FGAIAircraft *ac, time_t now = time(NULL) + fgGetLong("/sim/time/warp"); time_t timeDiff = now-start; leg = 1; - /* - if ((timeDiff > 300) && (timeDiff < 1200)) + + if ((timeDiff > 60) && (timeDiff < 1200)) leg = 2; else if ((timeDiff >= 1200) && (timeDiff < 1500)) leg = 3; @@ -196,14 +196,15 @@ FGAIFlightPlan::FGAIFlightPlan(FGAIAircraft *ac, leg = 4; else if (timeDiff >= 2000) leg = 5; - */ + /* if (timeDiff >= 2000) leg = 5; - + */ SG_LOG(SG_GENERAL, SG_INFO, "Route from " << dep->getId() << " to " << arr->getId() << ". Set leg to : " << leg << " " << ac->getTrafficRef()->getCallSign()); wpt_iterator = waypoints.begin(); + bool dist = 0; create(ac, dep,arr, leg, alt, speed, lat, lon, - firstLeg, radius, fltType, acType, airline); + firstLeg, radius, fltType, acType, airline, dist); wpt_iterator = waypoints.begin(); //cerr << "after create: " << (*wpt_iterator)->name << endl; //leg++; @@ -397,7 +398,7 @@ void FGAIFlightPlan::setLeadDistance(double speed, double bearing, return; } if (speed < 25) { - turn_radius = ((360/30)*15) / (2*M_PI); + turn_radius = ((360/30)*fabs(speed)) / (2*M_PI); } else turn_radius = 0.1911 * speed * speed; // an estimate for 25 degrees bank @@ -411,9 +412,17 @@ void FGAIFlightPlan::setLeadDistance(double speed, double bearing, //lead_distance = turn_radius * sin(leadInAngle * SG_DEGREES_TO_RADIANS); lead_distance = turn_radius * tan((leadInAngle * SG_DEGREES_TO_RADIANS)/2); - // if ((errno == EDOM) || (errno == ERANGE) || lead_distance < 1.0) - // { - // } + /* + if ((lead_distance > (3*turn_radius)) && (current->on_ground == false)) { + // cerr << "Warning: Lead-in distance is large. Inbound = " << inbound + // << ". Outbound = " << outbound << ". Lead in angle = " << leadInAngle << ". Turn radius = " << turn_radius << endl; + lead_distance = 3 * turn_radius; + return; + } + if ((leadInAngle > 90) && (current->on_ground == true)) { + lead_distance = turn_radius * tan((90 * SG_DEGREES_TO_RADIANS)/2); + return; + }*/ } void FGAIFlightPlan::setLeadDistance(double distance_ft){ @@ -486,3 +495,20 @@ int FGAIFlightPlan::getRouteIndex(int i) { else return 0; } + + +double FGAIFlightPlan::checkTrackLength(string wptName) { + // skip the first two waypoints: first one is behind, second one is partially done; + double trackDistance = 0; + wpt_vector_iterator wptvec = waypoints.begin(); + wptvec++; + wptvec++; + while ((wptvec != waypoints.end()) && ((*wptvec)->name != wptName)) { + trackDistance += (*wptvec)->trackLength; + wptvec++; + } + if (wptvec == waypoints.end()) { + trackDistance = 0; // name not found + } + return trackDistance; +} \ No newline at end of file