fly/flightgear
1
0
Fork 0
Code Activity

Nicer default SID and approach procedures.

Browse source 
Note these are still generic and do NOT take local terrain into account. Don't come crying to me if you fly into nearby terrain because you weren't using a real procedure!
This commit is contained in:
James Turner 2012-12-30 15:37:25 +00:00
parent 8aa05a871a
commit 44a44a0246
1 changed files with 65 additions and 12 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

77
src/Autopilot/route_mgr.cxx
View file

@ -918,7 +918,14 @@ const char* FGRouteMgr::getSID() const
return ""; return "";
} }
flightgear::SID* createDefaultSID(FGRunway* aRunway) static double headingDiffDeg(double a, double b)
{
double rawDiff = b - a;
SG_NORMALIZE_RANGE(rawDiff, -180.0, 180.0);
return rawDiff;
}
flightgear::SID* createDefaultSID(FGRunway* aRunway, double enrouteCourse)
{ {
if (!aRunway) { if (!aRunway) {
return NULL; return NULL;
@ -931,23 +938,41 @@ flightgear::SID* createDefaultSID(FGRunway* aRunway)
SGGeod p = aRunway->pointOnCenterline(aRunway->lengthM() + (3.0 * SG_NM_TO_METER)); SGGeod p = aRunway->pointOnCenterline(aRunway->lengthM() + (3.0 * SG_NM_TO_METER));
WayptRef w = new BasicWaypt(p, ss.str(), NULL); WayptRef w = new BasicWaypt(p, ss.str(), NULL);
w->setAltitude(runwayElevFt + 2000.0, RESTRICT_AT); w->setAltitude(runwayElevFt + 3000.0, RESTRICT_AT);
wpts.push_back(w); wpts.push_back(w);
ss.str(""); ss.str("");
ss << aRunway->ident() << "-6"; ss << aRunway->ident() << "-6";
p = aRunway->pointOnCenterline(aRunway->lengthM() + (6.0 * SG_NM_TO_METER)); p = aRunway->pointOnCenterline(aRunway->lengthM() + (6.0 * SG_NM_TO_METER));
w = new BasicWaypt(p, ss.str(), NULL); w = new BasicWaypt(p, ss.str(), NULL);
w->setAltitude(runwayElevFt + 4000.0, RESTRICT_AT);
wpts.push_back(w);
ss.str("");
ss << aRunway->ident() << "-9";
p = aRunway->pointOnCenterline(aRunway->lengthM() + (9.0 * SG_NM_TO_METER));
w = new BasicWaypt(p, ss.str(), NULL);
w->setAltitude(runwayElevFt + 6000.0, RESTRICT_AT); w->setAltitude(runwayElevFt + 6000.0, RESTRICT_AT);
wpts.push_back(w); wpts.push_back(w);
if (enrouteCourse >= 0.0) {
// valid enroute course
int index = 3;
double course = aRunway->headingDeg();
double diff;
while (fabs(diff = headingDiffDeg(course, enrouteCourse)) > 45.0) {
// turn in the sign of the heading change 45 degrees
course += copysign(45.0, diff);
ss.str("");
ss << "DEP-" << index++;
SGGeod pos = wpts.back()->position();
pos = SGGeodesy::direct(pos, course, 3.0 * SG_NM_TO_METER);
w = new BasicWaypt(pos, ss.str(), NULL);
wpts.push_back(w);
}
} else {
// no enroute course, just keep runway heading
ss.str("");
ss << aRunway->ident() << "-9";
p = aRunway->pointOnCenterline(aRunway->lengthM() + (9.0 * SG_NM_TO_METER));
w = new BasicWaypt(p, ss.str(), NULL);
w->setAltitude(runwayElevFt + 9000.0, RESTRICT_AT);
wpts.push_back(w);
}
BOOST_FOREACH(Waypt* w, wpts) { BOOST_FOREACH(Waypt* w, wpts) {
w->setFlag(WPT_DEPARTURE); w->setFlag(WPT_DEPARTURE);
w->setFlag(WPT_GENERATED); w->setFlag(WPT_GENERATED);
@ -965,7 +990,12 @@ void FGRouteMgr::setSID(const char* aIdent)
} }
if (!strcmp(aIdent, "DEFAULT")) { if (!strcmp(aIdent, "DEFAULT")) {
_plan->setSID(createDefaultSID(_plan->departureRunway())); double enrouteCourse = -1.0;
if (_plan->destinationAirport()) {
enrouteCourse = SGGeodesy::courseDeg(apt->geod(), _plan->destinationAirport()->geod());
}
_plan->setSID(createDefaultSID(_plan->departureRunway(), enrouteCourse));
return; return;
} }
@ -1038,7 +1068,7 @@ const char* FGRouteMgr::getApproach() const
return ""; return "";
} }
flightgear::Approach* createDefaultApproach(FGRunway* aRunway) flightgear::Approach* createDefaultApproach(FGRunway* aRunway, double aEnrouteCourse)
{ {
if (!aRunway) { if (!aRunway) {
return NULL; return NULL;
@ -1057,6 +1087,24 @@ flightgear::Approach* createDefaultApproach(FGRunway* aRunway)
w->setAltitude(thresholdElevFt + 4000, RESTRICT_AT); w->setAltitude(thresholdElevFt + 4000, RESTRICT_AT);
wpts.push_back(w); wpts.push_back(w);
// work back form the first point on the centerline
if (aEnrouteCourse >= 0.0) {
// valid enroute course
int index = 4;
double course = aRunway->headingDeg();
double diff;
while (fabs(diff = headingDiffDeg(aEnrouteCourse, course)) > 45.0) {
// turn in the sign of the heading change 45 degrees
course -= copysign(45.0, diff);
ss.str("");
ss << "APP-" << index++;
SGGeod pos = wpts.front()->position();
pos = SGGeodesy::direct(pos, course + 180.0, 3.0 * SG_NM_TO_METER);
w = new BasicWaypt(pos, ss.str(), NULL);
wpts.insert(wpts.begin(), w);
}
}
p = aRunway->pointOnCenterline(-8.0 * SG_NM_TO_METER); p = aRunway->pointOnCenterline(-8.0 * SG_NM_TO_METER);
ss.str(""); ss.str("");
@ -1084,7 +1132,12 @@ void FGRouteMgr::setApproach(const char* aIdent)
{ {
FGAirport* apt = _plan->destinationAirport(); FGAirport* apt = _plan->destinationAirport();
if (!strcmp(aIdent, "DEFAULT")) { if (!strcmp(aIdent, "DEFAULT")) {
_plan->setApproach(createDefaultApproach(_plan->destinationRunway())); double enrouteCourse = -1.0;
if (_plan->departureAirport()) {
enrouteCourse = SGGeodesy::courseDeg(_plan->departureAirport()->geod(), apt->geod());
}
_plan->setApproach(createDefaultApproach(_plan->destinationRunway(), enrouteCourse));
return; return;
} }