678 lines
24 KiB
C++
678 lines
24 KiB
C++
#include "test_routeManager.hxx"
|
|
|
|
#include <memory>
|
|
#include <cstring>
|
|
|
|
#include <simgear/misc/sg_dir.hxx>
|
|
#include <simgear/io/iostreams/sgstream.hxx>
|
|
|
|
#include "test_suite/FGTestApi/testGlobals.hxx"
|
|
#include "test_suite/FGTestApi/NavDataCache.hxx"
|
|
#include "test_suite/FGTestApi/TestPilot.hxx"
|
|
|
|
#include <Navaids/FlightPlan.hxx>
|
|
#include <Navaids/NavDataCache.hxx>
|
|
#include <Navaids/navrecord.hxx>
|
|
#include <Navaids/navlist.hxx>
|
|
#include <Navaids/routePath.hxx>
|
|
|
|
// we need a default GPS instrument, hard to test seperately for now
|
|
#include <Instrumentation/gps.hxx>
|
|
|
|
#include <Autopilot/route_mgr.hxx>
|
|
|
|
using namespace flightgear;
|
|
|
|
static FlightPlanRef makeTestFP(const std::string& depICAO, const std::string& depRunway,
|
|
const std::string& destICAO, const std::string& destRunway,
|
|
const std::string& waypoints)
|
|
{
|
|
FlightPlanRef f = new FlightPlan;
|
|
FGTestApi::setUp::populateFPWithNasal(f, depICAO, depRunway, destICAO, destRunway, waypoints);
|
|
return f;
|
|
}
|
|
|
|
|
|
// Set up function for each test.
|
|
void RouteManagerTests::setUp()
|
|
{
|
|
FGTestApi::setUp::initTestGlobals("routemanager");
|
|
FGTestApi::setUp::initNavDataCache();
|
|
|
|
globals->add_new_subsystem<FGRouteMgr>();
|
|
|
|
// setup the default GPS, which is needed for waypoint
|
|
// sequencing to work
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "gps");
|
|
configNode->setIntValue("number", 0);
|
|
GPS* gps(new GPS(configNode, true /* default mode */));
|
|
m_gps = gps;
|
|
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation", true)->getChild("gps", 0, true);
|
|
// node->setBoolValue("serviceable", true);
|
|
// globals->get_props()->setDoubleValue("systems/electrical/outputs/gps", 6.0);
|
|
globals->add_subsystem("gps", gps, SGSubsystemMgr::POST_FDM);
|
|
|
|
globals->get_subsystem_mgr()->bind();
|
|
globals->get_subsystem_mgr()->init();
|
|
|
|
FGTestApi::setUp::initStandardNasal();
|
|
globals->get_subsystem_mgr()->postinit();
|
|
}
|
|
|
|
|
|
// Clean up after each test.
|
|
void RouteManagerTests::tearDown()
|
|
{
|
|
m_gps = nullptr;
|
|
FGTestApi::tearDown::shutdownTestGlobals();
|
|
}
|
|
|
|
void RouteManagerTests::setPositionAndStabilise(const SGGeod& g)
|
|
{
|
|
FGTestApi::setPosition(g);
|
|
for (int i=0; i<60; ++i) {
|
|
globals->get_subsystem_mgr()->update(0.02);
|
|
}
|
|
}
|
|
|
|
void RouteManagerTests::testBasic()
|
|
{
|
|
//FGTestApi::setUp::logPositionToKML("rm_basic");
|
|
|
|
FlightPlanRef fp1 = makeTestFP("EGLC", "27", "EHAM", "06",
|
|
"CLN IDESI RINIS VALKO RIVER RTM EKROS");
|
|
fp1->setIdent("testplan");
|
|
fp1->setCruiseFlightLevel(360);
|
|
|
|
auto rm = globals->get_subsystem<FGRouteMgr>();
|
|
rm->setFlightPlan(fp1);
|
|
|
|
auto gpsNode = globals->get_props()->getNode("instrumentation/gps", true);
|
|
CPPUNIT_ASSERT(!strcmp("obs", gpsNode->getStringValue("mode")));
|
|
|
|
rm->activate();
|
|
|
|
CPPUNIT_ASSERT(fp1->isActive());
|
|
|
|
// Nasal deleagte should have placed GPS into leg mode
|
|
auto rmNode = globals->get_props()->getNode("autopilot/route-manager", true);
|
|
|
|
CPPUNIT_ASSERT(!strcmp("leg", gpsNode->getStringValue("mode")));
|
|
|
|
CPPUNIT_ASSERT(!strcmp("EGLC", rmNode->getStringValue("departure/airport")));
|
|
CPPUNIT_ASSERT(!strcmp("27", rmNode->getStringValue("departure/runway")));
|
|
CPPUNIT_ASSERT(!strcmp("", rmNode->getStringValue("departure/sid")));
|
|
CPPUNIT_ASSERT(!strcmp("London City", rmNode->getStringValue("departure/name")));
|
|
|
|
CPPUNIT_ASSERT(!strcmp("EHAM", rmNode->getStringValue("destination/airport")));
|
|
CPPUNIT_ASSERT(!strcmp("06", rmNode->getStringValue("destination/runway")));
|
|
|
|
CPPUNIT_ASSERT_EQUAL(360, rmNode->getIntValue("cruise/flight-level"));
|
|
CPPUNIT_ASSERT_EQUAL(false, rmNode->getBoolValue("airborne"));
|
|
|
|
CPPUNIT_ASSERT_EQUAL(0, rmNode->getIntValue("current-wp"));
|
|
auto wp0Node = rmNode->getNode("wp");
|
|
CPPUNIT_ASSERT(!strcmp("EGLC-27", wp0Node->getStringValue("id")));
|
|
|
|
auto wp1Node = rmNode->getNode("wp[1]");
|
|
CPPUNIT_ASSERT(!strcmp("CLN", wp1Node->getStringValue("id")));
|
|
|
|
FGPositioned::TypeFilter f{FGPositioned::VOR};
|
|
auto clactonVOR = fgpositioned_cast<FGNavRecord>(FGPositioned::findClosestWithIdent("CLN", SGGeod::fromDeg(0.0, 51.0), &f));
|
|
|
|
// verify hold entry course
|
|
auto pilot = SGSharedPtr<FGTestApi::TestPilot>(new FGTestApi::TestPilot);
|
|
FGTestApi::setPosition(fp1->departureRunway()->geod());
|
|
pilot->resetAtPosition(fp1->departureRunway()->geod());
|
|
|
|
pilot->setSpeedKts(220);
|
|
pilot->setCourseTrue(fp1->departureRunway()->headingDeg());
|
|
pilot->setTargetAltitudeFtMSL(10000);
|
|
|
|
bool ok = FGTestApi::runForTimeWithCheck(30.0, [rmNode] () {
|
|
if (rmNode->getIntValue("current-wp") == 1) return true;
|
|
return false;
|
|
});
|
|
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// continue outbound for some time
|
|
pilot->setSpeedKts(250);
|
|
FGTestApi::runForTime(30.0);
|
|
|
|
// turn towards Clacton VOR
|
|
pilot->flyDirectTo(clactonVOR->geod());
|
|
pilot->setTargetAltitudeFtMSL(30000);
|
|
pilot->setSpeedKts(280);
|
|
ok = FGTestApi::runForTimeWithCheck(6000.0, [rmNode] () {
|
|
if (rmNode->getIntValue("current-wp") == 2) return true;
|
|
return false;
|
|
});
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// short straight leg for testing
|
|
pilot->flyHeading(90.0);
|
|
pilot->setSpeedKts(330);
|
|
FGTestApi::runForTime(30.0);
|
|
|
|
// let's engage LNAV mode :)
|
|
pilot->flyGPSCourse(m_gps);
|
|
|
|
ok = FGTestApi::runForTimeWithCheck(6000.0, [rmNode] () {
|
|
if (rmNode->getIntValue("current-wp") == 5) return true;
|
|
return false;
|
|
});
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// check where we are - should be heading to RIVER from VALKO
|
|
CPPUNIT_ASSERT_EQUAL(5, rmNode->getIntValue("current-wp"));
|
|
CPPUNIT_ASSERT(!strcmp("RIVER", wp0Node->getStringValue("id")));
|
|
CPPUNIT_ASSERT(!strcmp("RTM", wp1Node->getStringValue("id")));
|
|
// slightly rapid descent
|
|
pilot->setTargetAltitudeFtMSL(3000);
|
|
|
|
ok = FGTestApi::runForTimeWithCheck(6000.0, [rmNode] () {
|
|
if (rmNode->getIntValue("current-wp") == 7) return true;
|
|
return false;
|
|
});
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// run until the GPS reverts to OBS mode at the end of the flight plan
|
|
ok = FGTestApi::runForTimeWithCheck(6000.0, [gpsNode] () {
|
|
std::string mode = gpsNode->getStringValue("mode");
|
|
if (mode == "obs") return true;
|
|
return false;
|
|
});
|
|
|
|
CPPUNIT_ASSERT(ok);
|
|
CPPUNIT_ASSERT_EQUAL(-1, fp1->currentIndex());
|
|
CPPUNIT_ASSERT(!fp1->isActive());
|
|
CPPUNIT_ASSERT_EQUAL(-1, rmNode->getIntValue("current-wp"));
|
|
CPPUNIT_ASSERT_EQUAL(false, rmNode->getBoolValue("active"));
|
|
}
|
|
|
|
void RouteManagerTests::testDefaultSID()
|
|
{
|
|
FlightPlanRef fp1 = makeTestFP("EGLC", "27", "EHAM", "24",
|
|
"CLN IDRID VALKO");
|
|
fp1->setIdent("testplan");
|
|
|
|
auto rm = globals->get_subsystem<FGRouteMgr>();
|
|
rm->setFlightPlan(fp1);
|
|
|
|
auto rmNode = globals->get_props()->getNode("autopilot/route-manager", true);
|
|
rmNode->setStringValue("departure/sid", "DEFAULT");
|
|
|
|
// let's see what we got :)
|
|
|
|
rm->activate();
|
|
|
|
CPPUNIT_ASSERT(fp1->isActive());
|
|
}
|
|
|
|
void RouteManagerTests::testDirectToLegOnFlightplanAndResume()
|
|
{
|
|
// FGTestApi::setUp::logPositionToKML("rm_dto_resume_leg");
|
|
|
|
// this is very similar to the identiucally name dtest in GPSTests, but relies on the Nasal
|
|
// route manager delegate to perform the same task
|
|
FlightPlanRef fp1 = makeTestFP("EBBR", "07L", "EGGD", "27",
|
|
"NIK COA DVR TAWNY WOD");
|
|
auto rm = globals->get_subsystem<FGRouteMgr>();
|
|
rm->setFlightPlan(fp1);
|
|
// FGTestApi::writeFlightPlanToKML(fp1);
|
|
|
|
auto gpsNode = globals->get_props()->getNode("instrumentation/gps", true);
|
|
auto rmNode = globals->get_props()->getNode("autopilot/route-manager", true);
|
|
|
|
CPPUNIT_ASSERT(!strcmp("obs", gpsNode->getStringValue("mode")));
|
|
rm->activate();
|
|
|
|
CPPUNIT_ASSERT(fp1->isActive());
|
|
|
|
FGTestApi::setPosition(fp1->departureRunway()->pointOnCenterline(0.0));
|
|
FGTestApi::runForTime(10.0); // let the GPS stabilize
|
|
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"leg"}, std::string{gpsNode->getStringValue("mode")});
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"EBBR-07L"}, std::string{gpsNode->getStringValue("wp/wp[1]/ID")});
|
|
|
|
CPPUNIT_ASSERT_EQUAL(0, rmNode->getIntValue("current-wp"));
|
|
auto wp0Node = rmNode->getNode("wp");
|
|
CPPUNIT_ASSERT(!strcmp("EBBR-07L", wp0Node->getStringValue("id")));
|
|
|
|
auto wp1Node = rmNode->getNode("wp[1]");
|
|
CPPUNIT_ASSERT(!strcmp("NIK", wp1Node->getStringValue("id")));
|
|
|
|
// initiate a direct to
|
|
SGGeod p2 = fp1->departureRunway()->pointOnCenterline(5.0* SG_NM_TO_METER);
|
|
FGTestApi::setPosition(p2);
|
|
|
|
auto doverVOR = fp1->legAtIndex(3)->waypoint()->source();
|
|
|
|
double distanceToDover = SGGeodesy::distanceNm(p2, doverVOR->geod());
|
|
double bearingToDover = SGGeodesy::courseDeg(p2, doverVOR->geod());
|
|
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"DVR"}, doverVOR->ident());
|
|
gpsNode->setStringValue("scratch/ident", "DVR");
|
|
gpsNode->setDoubleValue("scratch/longitude-deg", doverVOR->geod().getLongitudeDeg());
|
|
gpsNode->setDoubleValue("scratch/latitude-deg", doverVOR->geod().getLatitudeDeg());
|
|
gpsNode->setStringValue("command", "direct");
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"dto"}, std::string{gpsNode->getStringValue("mode")});
|
|
|
|
// check that upon reaching DOVER, we sequence to TAWNY and resume leg mode
|
|
// this is handled by the default delegate in Nasal
|
|
|
|
SGGeod posNearDover = SGGeodesy::direct(p2, bearingToDover, (distanceToDover - 8.0) * SG_NM_TO_METER);
|
|
FGTestApi::setPosition(posNearDover);
|
|
|
|
auto pilot = SGSharedPtr<FGTestApi::TestPilot>(new FGTestApi::TestPilot);
|
|
pilot->resetAtPosition(posNearDover);
|
|
pilot->setSpeedKts(250);
|
|
pilot->flyGPSCourse(m_gps);
|
|
|
|
bool ok = FGTestApi::runForTimeWithCheck(180.0, [fp1] () {
|
|
if (fp1->currentIndex() == 4) {
|
|
return true;
|
|
}
|
|
return false;
|
|
});
|
|
|
|
CPPUNIT_ASSERT(ok);
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"leg"}, std::string{gpsNode->getStringValue("mode")});
|
|
}
|
|
|
|
void RouteManagerTests::testSequenceDiscontinuityAndResume()
|
|
{
|
|
// FGTestApi::setUp::logPositionToKML("rm_seq_discon_resume_leg");
|
|
|
|
FlightPlanRef fp1 = makeTestFP("LIRF", "16R", "LEBL", "07L",
|
|
"GITRI BALEN MUREN TOSNU");
|
|
|
|
|
|
fp1->insertWayptAtIndex(new Discontinuity(fp1), 3);
|
|
|
|
auto rm = globals->get_subsystem<FGRouteMgr>();
|
|
rm->setFlightPlan(fp1);
|
|
|
|
auto gpsNode = globals->get_props()->getNode("instrumentation/gps", true);
|
|
// auto rmNode = globals->get_props()->getNode("autopilot/route-manager", true);
|
|
|
|
auto balenLeg = fp1->legAtIndex(2);
|
|
auto pos = fp1->pointAlongRoute(2, -8.0); // 8nm before BALEN
|
|
FGTestApi::setPosition(pos);
|
|
FGTestApi::runForTime(10.0); // let the GPS stabilize
|
|
|
|
CPPUNIT_ASSERT(!strcmp("obs", gpsNode->getStringValue("mode")));
|
|
rm->activate();
|
|
|
|
CPPUNIT_ASSERT(fp1->isActive());
|
|
|
|
CPPUNIT_ASSERT(std::string{"leg"} == gpsNode->getStringValue("mode"));
|
|
fp1->setCurrentIndex(2);
|
|
|
|
auto pilot = SGSharedPtr<FGTestApi::TestPilot>(new FGTestApi::TestPilot);
|
|
pilot->resetAtPosition(pos);
|
|
pilot->setCourseTrue(270);
|
|
pilot->setSpeedKts(250);
|
|
pilot->flyGPSCourse(m_gps);
|
|
|
|
bool ok = FGTestApi::runForTimeWithCheck(180.0, [gpsNode] () {
|
|
return (gpsNode->getStringValue("mode") == std::string{"obs"});
|
|
});
|
|
|
|
CPPUNIT_ASSERT(ok);
|
|
CPPUNIT_ASSERT_EQUAL(2, fp1->currentIndex()); // shouldn't sequence
|
|
|
|
FGTestApi::runForTime(30.0);
|
|
|
|
|
|
// 2nm before MUREN : this should be on the GC course from BALEN
|
|
auto pos2 = fp1->pointAlongRoute(4, -6.0);
|
|
FGTestApi::setPosition(pos2);
|
|
FGTestApi::runForTime(2.0); // let the GPS stabilize
|
|
|
|
// initiate a direct-to the next real WP
|
|
const auto murenPos = fp1->legAtIndex(4)->waypoint()->position();
|
|
gpsNode->setStringValue("scratch/ident", "MUREN");
|
|
gpsNode->setDoubleValue("scratch/longitude-deg", murenPos.getLongitudeDeg());
|
|
gpsNode->setDoubleValue("scratch/latitude-deg", murenPos.getLatitudeDeg());
|
|
gpsNode->setStringValue("command", "direct");
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"dto"}, std::string{gpsNode->getStringValue("mode")});
|
|
|
|
pilot->resetAtPosition(pos2);
|
|
pilot->flyGPSCourse(m_gps);
|
|
|
|
ok = FGTestApi::runForTimeWithCheck(600.0, [fp1] () {
|
|
if (fp1->currentIndex() == 5) {
|
|
return true;
|
|
}
|
|
return false;
|
|
});
|
|
|
|
CPPUNIT_ASSERT(ok);
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"leg"}, std::string{gpsNode->getStringValue("mode")});
|
|
CPPUNIT_ASSERT_EQUAL(5, fp1->currentIndex());
|
|
|
|
FGTestApi::runForTime(30.0);
|
|
|
|
}
|
|
|
|
void RouteManagerTests::testDefaultApproach()
|
|
{
|
|
|
|
}
|
|
|
|
void RouteManagerTests::testHiddenWaypoints()
|
|
{
|
|
FlightPlanRef fp1 = makeTestFP("NZCH", "02", "NZAA", "05L",
|
|
"ALADA NS WB WN MAMOD KAPTI OH");
|
|
fp1->setIdent("testplan");
|
|
fp1->setCruiseFlightLevel(360);
|
|
|
|
auto rm = globals->get_subsystem<FGRouteMgr>();
|
|
rm->setFlightPlan(fp1);
|
|
|
|
auto gpsNode = globals->get_props()->getNode("instrumentation/gps", true);
|
|
CPPUNIT_ASSERT(!strcmp("obs", gpsNode->getStringValue("mode")));
|
|
|
|
// FIXME: use real Nasal test macros soon
|
|
auto testNode = globals->get_props()->getNode("test-data", true);
|
|
|
|
fp1->legAtIndex(3)->waypoint()->setFlag(WPT_HIDDEN);
|
|
|
|
// ensure no visual path is generated for hidden waypoints
|
|
RoutePath path(fp1);
|
|
CPPUNIT_ASSERT(path.pathForIndex(3).empty());
|
|
|
|
|
|
bool ok = FGTestApi::executeNasal(R"(
|
|
var fp = flightplan(); # retrieve the global flightplan
|
|
setprop("/test-data/a", fp.numRemainingWaypoints());
|
|
)");
|
|
CPPUNIT_ASSERT(ok);
|
|
CPPUNIT_ASSERT_EQUAL(fp1->numLegs(), testNode->getIntValue("a"));
|
|
|
|
rm->activate();
|
|
fp1->setCurrentIndex(2);
|
|
|
|
ok = FGTestApi::executeNasal(R"(
|
|
var fp = flightplan(); # retrieve the global flightplan
|
|
setprop("/test-data/a", fp.numRemainingWaypoints());
|
|
setprop("/test-data/b", fp.currentWP(2).id);
|
|
)");
|
|
|
|
CPPUNIT_ASSERT(ok);
|
|
CPPUNIT_ASSERT_EQUAL(7, testNode->getIntValue("a"));
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"WN"}, std::string{testNode->getStringValue("b")});
|
|
|
|
ok = FGTestApi::executeNasal(R"(
|
|
var fp = flightplan(); # retrieve the global flightplan
|
|
setprop("/test-data/c", fp.currentWP(-1).id);
|
|
|
|
# ensure invalid offset returns nil
|
|
setprop("/test-data/d", fp.currentWP(-100) == nil);
|
|
)");
|
|
|
|
CPPUNIT_ASSERT(ok);
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"ALADA"}, std::string{testNode->getStringValue("c")});
|
|
CPPUNIT_ASSERT_EQUAL(true, testNode->getBoolValue("d"));
|
|
}
|
|
|
|
void RouteManagerTests::testHoldFromNasal()
|
|
{
|
|
// FGTestApi::setUp::logPositionToKML("rm_hold_from_nasal");
|
|
|
|
// test that Nasal can set a hold-count (implicitly converting a leg
|
|
// to a Hold waypt), configure the hold radial, and exit the hold
|
|
|
|
FlightPlanRef fp1 = makeTestFP("NZCH", "02", "NZAA", "05L",
|
|
"ALADA NS WB WN MAMOD KAPTI OH");
|
|
fp1->setIdent("testplan");
|
|
fp1->setCruiseFlightLevel(360);
|
|
|
|
auto rm = globals->get_subsystem<FGRouteMgr>();
|
|
rm->setFlightPlan(fp1);
|
|
// FGTestApi::writeFlightPlanToKML(fp1);
|
|
|
|
auto gpsNode = globals->get_props()->getNode("instrumentation/gps", true);
|
|
CPPUNIT_ASSERT(!strcmp("obs", gpsNode->getStringValue("mode")));
|
|
|
|
rm->activate();
|
|
|
|
CPPUNIT_ASSERT(fp1->isActive());
|
|
CPPUNIT_ASSERT(!strcmp("leg", gpsNode->getStringValue("mode")));
|
|
|
|
SGGeod posEnrouteToWB = fp1->pointAlongRoute(3, -10.0);
|
|
FGTestApi::setPositionAndStabilise(posEnrouteToWB);
|
|
|
|
// sequence everything to the correct wp
|
|
fp1->setCurrentIndex(3);
|
|
|
|
// setup some hold data from Nasal. To make it more challenging,
|
|
// do it once the wp is already active
|
|
bool ok = FGTestApi::executeNasal(R"(
|
|
var fp = flightplan(); # retrieve the global flightplan
|
|
var leg = fp.getWP(3);
|
|
leg.hold_count = 4;
|
|
leg.hold_heading_radial_deg = 310;
|
|
)");
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// check the value updated in the leg
|
|
CPPUNIT_ASSERT_EQUAL(4, fp1->legAtIndex(3)->holdCount());
|
|
|
|
// check we converted to a hold
|
|
auto wp = fp1->legAtIndex(3)->waypoint();
|
|
auto holdWpt = static_cast<flightgear::Hold*>(wp);
|
|
|
|
CPPUNIT_ASSERT_EQUAL(wp->type(), std::string{"hold"});
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(310.0, holdWpt->headingRadialDeg(), 0.5);
|
|
|
|
// establish the test pilot at this position too
|
|
auto pilot = SGSharedPtr<FGTestApi::TestPilot>(new FGTestApi::TestPilot);
|
|
pilot->resetAtPosition(posEnrouteToWB);
|
|
pilot->setSpeedKts(250);
|
|
pilot->flyGPSCourse(m_gps);
|
|
pilot->setCourseTrue(gpsNode->getDoubleValue("wp/leg-true-course-deg"));
|
|
|
|
// run for a bit to stabilize everything
|
|
FGTestApi::runForTime(5.0);
|
|
|
|
// check we upgraded to a hold controller internally, and are flying to it :)
|
|
auto statusNode = gpsNode->getNode("rnav-controller-status");
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"leg-to-hold"}, std::string{statusNode->getStringValue()});
|
|
|
|
// check we're on the leg
|
|
|
|
auto wbPos = fp1->legAtIndex(3)->waypoint()->position();
|
|
auto nsPos = fp1->legAtIndex(2)->waypoint()->position();
|
|
const double crsToWB = SGGeodesy::courseDeg(globals->get_aircraft_position(), wbPos);
|
|
const double crsNSWB = SGGeodesy::courseDeg(nsPos,wbPos);
|
|
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(crsToWB, gpsNode->getDoubleValue("wp/wp[1]/bearing-true-deg"), 0.5);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(crsNSWB, gpsNode->getDoubleValue("wp/leg-true-course-deg"), 0.5);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(0.0, gpsNode->getDoubleValue("wp/wp[1]/course-error-nm"), 0.05);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(0.0, gpsNode->getDoubleValue("wp/wp[1]/course-deviation-deg"), 0.5);
|
|
|
|
// fly into the hold, should be teardrop entry
|
|
ok = FGTestApi::runForTimeWithCheck(600.0, [statusNode] () {
|
|
std::string s = statusNode->getStringValue();
|
|
if (s == "entry-teardrop") return true;
|
|
return false;
|
|
});
|
|
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
ok = FGTestApi::runForTimeWithCheck(600.0, [statusNode] () {
|
|
std::string s = statusNode->getStringValue();
|
|
if (s == "hold-inbound") return true;
|
|
return false;
|
|
});
|
|
|
|
ok = FGTestApi::runForTimeWithCheck(600.0, [statusNode] () {
|
|
std::string s = statusNode->getStringValue();
|
|
if (s == "hold-outbound") return true;
|
|
return false;
|
|
});
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// half way through the outbound turn
|
|
FGTestApi::runForTime(30.0);
|
|
|
|
ok = FGTestApi::executeNasal(R"(
|
|
setprop("/instrumentation/gps/command", "exit-hold");
|
|
)");
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// no change yet
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"hold-outbound"}, std::string{statusNode->getStringValue()});
|
|
|
|
// then we fly inbound
|
|
ok = FGTestApi::runForTimeWithCheck(600.0, [statusNode] () {
|
|
std::string s = statusNode->getStringValue();
|
|
if (s == "hold-inbound") return true;
|
|
return false;
|
|
});
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// and then we exit
|
|
ok = FGTestApi::runForTimeWithCheck(600.0, [fp1] () {
|
|
if (fp1->currentIndex() == 4) return true;
|
|
return false;
|
|
});
|
|
CPPUNIT_ASSERT(ok);
|
|
|
|
// get back on course
|
|
FGTestApi::runForTime(60.0);
|
|
}
|
|
|
|
// check that when loading a GPX, airport waypoints are created
|
|
// by the default delegate
|
|
// https://sourceforge.net/p/flightgear/codetickets/2227/
|
|
void RouteManagerTests::loadGPX()
|
|
{
|
|
auto rm = globals->get_subsystem<FGRouteMgr>();
|
|
|
|
FlightPlanRef f = new FlightPlan;
|
|
rm->setFlightPlan(f);
|
|
|
|
SGPath gpxPath = simgear::Dir::current().path() / "test_gpx.gpx";
|
|
{
|
|
sg_ofstream s(gpxPath);
|
|
s << R"(<?xml version="1.0" encoding="UTF-8"?>
|
|
<gpx xmlns="http://www.topografix.com/GPX/1/1" xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance" creator="SkyVector" version="1.1" xsi:schemaLocation="http://www.topografix.com/GPX/1/1 http://www.topografix.com/GPX/1/1/gpx.xsd">
|
|
<rte>
|
|
<name>KJFK-KBOS</name>
|
|
<rtept lat="40.639928" lon="-73.778692">
|
|
<name>KJFK</name>
|
|
<overfly>false</overfly>
|
|
</rtept>
|
|
<rtept lat="41.641106" lon="-72.547419">
|
|
<name>HFD</name>
|
|
<overfly>false</overfly>
|
|
</rtept>
|
|
<rtept lat="42.362944" lon="-71.006389">
|
|
<name>KBOS</name>
|
|
<overfly>false</overfly>
|
|
</rtept>
|
|
|
|
</rte>
|
|
</gpx>
|
|
)";
|
|
}
|
|
|
|
CPPUNIT_ASSERT(f->load(gpxPath));
|
|
|
|
auto kbos = FGAirport::getByIdent("KBOS");
|
|
auto kjfk = FGAirport::getByIdent("KJFK");
|
|
CPPUNIT_ASSERT_EQUAL(kjfk, f->departureAirport());
|
|
CPPUNIT_ASSERT_EQUAL(static_cast<FGRunway*>(nullptr), f->departureRunway());
|
|
CPPUNIT_ASSERT_EQUAL(3, f->numLegs());
|
|
CPPUNIT_ASSERT_EQUAL(kbos, f->destinationAirport());
|
|
|
|
auto wp1 = f->legAtIndex(1);
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"HFD"}, wp1->waypoint()->ident());
|
|
auto wp2 = f->legAtIndex(2);
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"KBOS"}, wp2->waypoint()->ident());
|
|
}
|
|
|
|
// The same test as above, but for a file exported from the route manager or online
|
|
void RouteManagerTests::loadFgfp()
|
|
{
|
|
auto rm = globals->get_subsystem<FGRouteMgr>();
|
|
|
|
FlightPlanRef f = new FlightPlan;
|
|
rm->setFlightPlan(f);
|
|
|
|
SGPath fgfpPath = simgear::Dir::current().path() / "test_fgfp.fgfp";
|
|
{
|
|
sg_ofstream s(fgfpPath);
|
|
s << R"(<?xml version="1.0" encoding="UTF-8"?>
|
|
<PropertyList>
|
|
<version type="int">2</version>
|
|
<departure>
|
|
<airport type="string">EDDM</airport>
|
|
<runway type="string">08R</runway>
|
|
</departure>
|
|
<destination>
|
|
<airport type="string">EDDF</airport>
|
|
</destination>
|
|
<route>
|
|
<wp>
|
|
<type type="string">runway</type>
|
|
<departure type="bool">true</departure>
|
|
<ident type="string">08R</ident>
|
|
<icao type="string">EDDM</icao>
|
|
</wp>
|
|
<wp n="1">
|
|
<type type="string">navaid</type>
|
|
<ident type="string">GIVMI</ident>
|
|
<lon type="double">11.364700</lon>
|
|
<lat type="double">48.701100</lat>
|
|
</wp>
|
|
<wp n="2">
|
|
<type type="string">navaid</type>
|
|
<ident type="string">ERNAS</ident>
|
|
<lon type="double">11.219400</lon>
|
|
<lat type="double">48.844700</lat>
|
|
</wp>
|
|
<wp n="3">
|
|
<type type="string">navaid</type>
|
|
<ident type="string">TALAL</ident>
|
|
<lon type="double">11.085300</lon>
|
|
<lat type="double">49.108300</lat>
|
|
</wp>
|
|
<wp n="4">
|
|
<type type="string">navaid</type>
|
|
<ident type="string">ERMEL</ident>
|
|
<lon type="double">11.044700</lon>
|
|
<lat type="double">49.187800</lat>
|
|
</wp>
|
|
<wp n="5">
|
|
<type type="string">navaid</type>
|
|
<ident type="string">PSA</ident>
|
|
<lon type="double">9.348300</lon>
|
|
<lat type="double">49.862200</lat>
|
|
</wp>
|
|
</route>
|
|
</PropertyList>
|
|
)";
|
|
}
|
|
|
|
CPPUNIT_ASSERT(f->load(fgfpPath));
|
|
|
|
auto eddm = FGAirport::getByIdent("EDDM");
|
|
auto eddf = FGAirport::getByIdent("EDDF");
|
|
CPPUNIT_ASSERT_EQUAL(eddm, f->departureAirport());
|
|
CPPUNIT_ASSERT_EQUAL(eddm->getRunwayByIdent("08R")->ident(), f->departureRunway()->ident());
|
|
CPPUNIT_ASSERT_EQUAL(7, f->numLegs());
|
|
CPPUNIT_ASSERT_EQUAL(eddf, f->destinationAirport());
|
|
|
|
auto wp1 = f->legAtIndex(1);
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"GIVMI"}, wp1->waypoint()->ident());
|
|
auto wp2 = f->legAtIndex(6);
|
|
CPPUNIT_ASSERT_EQUAL(std::string{"EDDF"}, wp2->waypoint()->ident());
|
|
|
|
}
|