840 lines
47 KiB
C++
840 lines
47 KiB
C++
#include "test_navRadio.hxx"
|
|
|
|
#include <memory>
|
|
#include <cstring>
|
|
|
|
#include "test_suite/FGTestApi/testGlobals.hxx"
|
|
#include "test_suite/FGTestApi/NavDataCache.hxx"
|
|
|
|
#include <Navaids/NavDataCache.hxx>
|
|
#include <Navaids/navrecord.hxx>
|
|
#include <Navaids/navlist.hxx>
|
|
|
|
#include <Instrumentation/navradio.hxx>
|
|
|
|
// Set up function for each test.
|
|
void NavRadioTests::setUp()
|
|
{
|
|
FGTestApi::setUp::initTestGlobals("navradio");
|
|
FGTestApi::setUp::initNavDataCache();
|
|
}
|
|
|
|
|
|
// Clean up after each test.
|
|
void NavRadioTests::tearDown()
|
|
{
|
|
FGTestApi::tearDown::shutdownTestGlobals();
|
|
}
|
|
|
|
void NavRadioTests::setPositionAndStabilise(FGNavRadio* r, const SGGeod& g)
|
|
{
|
|
FGTestApi::setPosition(g);
|
|
for (int i=0; i<60; ++i) {
|
|
r->update(0.1);
|
|
}
|
|
}
|
|
|
|
std::string NavRadioTests::formatFrequency(double f)
|
|
{
|
|
char buf[16];
|
|
::snprintf(buf, 16, "%3.2f", f);
|
|
return buf;
|
|
}
|
|
|
|
void NavRadioTests::testBasic()
|
|
{
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
|
|
r->bind();
|
|
r->init();
|
|
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
// needed for the radio to power up
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
node->setDoubleValue("frequencies/selected-mhz", 113.8);
|
|
|
|
SGGeod pos = SGGeod::fromDegFt(-3.352780, 55.499199, 20000);
|
|
setPositionAndStabilise(r.get(), pos);
|
|
|
|
CPPUNIT_ASSERT_EQUAL(true, node->getBoolValue("operable"));
|
|
CPPUNIT_ASSERT(!strcmp("TLA", node->getStringValue("nav-id")));
|
|
CPPUNIT_ASSERT_EQUAL(true, node->getBoolValue("in-range"));
|
|
}
|
|
|
|
static const struct {
|
|
int nvType;
|
|
double nvLat, nvLon, nvAlt, nvFreq, nvRnge, nvTwst;
|
|
const string& nvIden;
|
|
double onRose, atDstNM, atAltFt, atHdg, rSele;
|
|
bool vOpnl, vToFlag;
|
|
double vSigNorm, vSigTolr, vHdgDefl, vDeflTolr, vHdgNorm, vDefnTolr, xtkTolr;
|
|
const string& tDesc;
|
|
} CDITestRoll[] = {
|
|
//
|
|
// Test Items: Add test cases here:
|
|
// nv<= fields are copied direct from nav dat => <= Rx pos wrt navaid, Radial =><= v- Values expected / tested => <= Line / Desc for Mesg =>
|
|
//Type Lat Lon Alt Freq Rnge Twist Iden] onRose atNm atAlt atHdg rSele Op To sigN - Tolr Defl - Tolr DNrm -Tolr xtkTolr
|
|
//
|
|
{ 3, 53.3, -2.26, 282, 113.55, 130, -5.0, "MCT", 25, 10.0, 4000, 200, 25, 1, 0, 1.0, 0.01, 0.0, 9.01, 0.0, 0.01, 50.0, "1: MCT EGCC On Radial" },
|
|
{ 3, 53.3, -2.26, 282, 113.55, 130, -5.0, "MCT", 25, 10.0, 4000, 200, 25, 1, 0, 1.0, 0.01, 0.0, 9.01, 0.0, 0.01, 50.0, "2: MCT EGCC On Again " },
|
|
{ 3, 53.3, -2.26, 282, 113.55, 130, -5.0, "MCT", 20, 20.0, 12000, 20, 25, 1, 0, 1.0, 0.01, 5.0, 0.1, 0.5, 0.01, 50.0, "3: MCT 5deg Off radial" },
|
|
{ 3, 53.3, -2.26, 282, 113.55, 130, -5.0, "MCT", 33, 30.0, 16000, 100, 25, 1, 0, 1.0, 0.01, -8.0, 0.1, -0.8, 0.01, 50.0, "4: MCT 8deg Off radial" },
|
|
{ 3, 53.3, -2.26, 282, 113.55, 130, -5.0, "MCT", 38, 40.0, 16000, 280, 25, 1, 0, 1.0, 0.01, -10.0, 0.1, -1.0, 0.01, 50.0, "5: MCT >10 Off radial" },
|
|
{ 3, -31.9, 115.95, 87, 113.70, 130, -2.0, "PH", 222, 20.0, 12000, 220, 42, 1, 1, 1.0, 0.01, 0.0, 0.01, 0.0, 0.01, 50.0, "6: PH Perth W.Aus On Radial"},
|
|
{ 3, -31.9, 115.95, 87, 113.70, 130, -2.0, "PH", 225, 20.0, 18000, 220, 42, 1, 1, 1.0, 0.01, 3.0, 0.01, 0.3, 0.01, 50.0, "7: PH +3deg Off radial" }
|
|
};
|
|
|
|
void NavRadioTests::callNavRadioCDI() {
|
|
//
|
|
//2021Ja15 set flag for newnavradio
|
|
//
|
|
fgSetBool("/instrumentation/use-new-navradio", true);
|
|
// setup
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
r->bind();
|
|
r->init();
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
// needed for the radio to power up
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
//
|
|
int tale = sizeof(CDITestRoll) / sizeof(CDITestRoll[0]);
|
|
for (int i = 0; (i < tale); i++) {
|
|
// prep error message
|
|
const string& itemDesc = " navradioCDI Item " + CDITestRoll[i].tDesc + " @ ";
|
|
// Txmitting navaid
|
|
node->setDoubleValue("frequencies/selected-mhz", CDITestRoll[i].nvFreq);
|
|
node->setDoubleValue("radials/selected-deg", CDITestRoll[i].rSele);
|
|
// tbd Filter on type as defined in nav dat
|
|
//FGPositioned::TypeFilter f{FGPositioned::VOR};
|
|
FGPositioned::TypeFilter f{{FGPositioned::VOR, FGPositioned::ILS, FGPositioned::LOC}};
|
|
FGNavRecordRef nav = fgpositioned_cast<FGNavRecord>(FGPositioned::findClosestWithIdent(CDITestRoll[i].nvIden,
|
|
SGGeod::fromDeg(CDITestRoll[i].nvLon, CDITestRoll[i].nvLat), &f));
|
|
//
|
|
// For VOR nav dat field 7: 'Twist' == Easterly rotation of Txmitter's 360 wrt True North c.f for Compass: 'Deviation West Rose is Best'
|
|
// Rx posn is specified according to navaid's radials as printed on chart: True Bng = ( Radial on Rose + Twist ( Deviation ))
|
|
// ( ftr: Both MCT -5 and PH -2 Are Negative Twists )
|
|
SGGeod posWrtRadial = SGGeodesy::direct(nav->geod(), (CDITestRoll[i].onRose + CDITestRoll[i].nvTwst),
|
|
(CDITestRoll[i].atDstNM * SG_NM_TO_METER));
|
|
posWrtRadial.setElevationFt(CDITestRoll[i].atAltFt);
|
|
setPositionAndStabilise(r.get(), posWrtRadial);
|
|
// heading-deg property below means bearing to txmitter; calc copied from navradio.cxx !!!
|
|
double bngToNavaid, az2, s;
|
|
SGGeodesy::inverse(posWrtRadial, (nav->geod()), bngToNavaid, az2, s);
|
|
// calc XTrack error
|
|
double xtkE = sin((CDITestRoll[i].rSele - CDITestRoll[i].onRose) * SG_DEGREES_TO_RADIANS) * (CDITestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
// Verify expected vs Result
|
|
string tMesg = itemDesc + "VOR type";
|
|
CPPUNIT_ASSERT_MESSAGE(tMesg, nav->type() == FGPositioned::VOR);
|
|
tMesg = itemDesc + "Operable";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vOpnl, node->getBoolValue("operable"));
|
|
tMesg = itemDesc + "TO Flag";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vToFlag, node->getBoolValue("to-flag"));
|
|
tMesg = itemDesc + "FROM Flag";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vToFlag, !node->getBoolValue("from-flag"));
|
|
//
|
|
tMesg = itemDesc + "nav-id";
|
|
CPPUNIT_ASSERT_MESSAGE(tMesg, !strcmp((CDITestRoll[i].nvIden).c_str(), node->getStringValue("nav-id")));
|
|
//tbd VOR seems to not set selected-mhz-fmt
|
|
// Converting nvFreq to string results in trailing zeros
|
|
tMesg = itemDesc + "selected-mhz-fmt";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, formatFrequency(CDITestRoll[i].nvFreq), string{node->getStringValue("frequencies/selected-mhz-fmt")});
|
|
// actual-deg means: bearing seen on intstrument's dial: actual == onRose
|
|
tMesg = itemDesc + "actual-deg";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, CDITestRoll[i].onRose, node->getDoubleValue("radials/actual-deg"), CDITestRoll[i].vDefnTolr);
|
|
// heading-deg means true bearing to navaid, not affected by plane's heading
|
|
tMesg = itemDesc + "heading-deg";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, bngToNavaid, node->getDoubleValue("heading-deg"), 1);
|
|
//
|
|
tMesg = itemDesc + "Sig Norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vSigNorm, node->getDoubleValue("signal-quality-norm"), CDITestRoll[i].vSigTolr);
|
|
tMesg = itemDesc + "needle defl";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vHdgDefl, node->getDoubleValue("heading-needle-deflection"), CDITestRoll[i].vDeflTolr);
|
|
tMesg = itemDesc + "defl norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vHdgNorm, node->getDoubleValue("heading-needle-deflection-norm"), CDITestRoll[i].vDefnTolr);
|
|
tMesg = itemDesc + "xTrack error";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xtkE, node->getDoubleValue("crosstrack-error-m"), CDITestRoll[i].xtkTolr);
|
|
}
|
|
}
|
|
|
|
void NavRadioTests::callNewNavRadioCDI()
|
|
{
|
|
//
|
|
//2021Ja15 set flag for newnavradio
|
|
//
|
|
fgSetBool("/instrumentation/use-new-navradio", true);
|
|
// setup
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
r->bind();
|
|
r->init();
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
// needed for the radio to power up
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
//
|
|
int tale = sizeof(CDITestRoll) / sizeof(CDITestRoll[0]);
|
|
for (int i = 0; (i < tale); i++) {
|
|
// prep error message
|
|
const string& itemDesc = " navradioCDI Item " + CDITestRoll[i].tDesc + " @ ";
|
|
// Txmitting navaid
|
|
node->setDoubleValue("frequencies/selected-mhz", CDITestRoll[i].nvFreq);
|
|
node->setDoubleValue("radials/selected-deg", CDITestRoll[i].rSele);
|
|
// tbd Filter on type as defined in nav dat
|
|
//FGPositioned::TypeFilter f{FGPositioned::VOR};
|
|
FGPositioned::TypeFilter f{{FGPositioned::VOR, FGPositioned::ILS, FGPositioned::LOC}};
|
|
FGNavRecordRef nav = fgpositioned_cast<FGNavRecord>(FGPositioned::findClosestWithIdent(CDITestRoll[i].nvIden,
|
|
SGGeod::fromDeg(CDITestRoll[i].nvLon, CDITestRoll[i].nvLat), &f));
|
|
//
|
|
// For VOR nav dat field 7: 'Twist' == Easterly rotation of Txmitter's 360 wrt True North c.f for Compass: 'Deviation West Rose is Best'
|
|
// Rx posn is specified according to navaid's radials as printed on chart: True Bng = ( Radial on Rose + Twist ( Deviation ))
|
|
// ( ftr: Both MCT -5 and PH -2 Are Negative Twists )
|
|
SGGeod posWrtRadial = SGGeodesy::direct(nav->geod(), (CDITestRoll[i].onRose + CDITestRoll[i].nvTwst),
|
|
(CDITestRoll[i].atDstNM * SG_NM_TO_METER));
|
|
posWrtRadial.setElevationFt(CDITestRoll[i].atAltFt);
|
|
setPositionAndStabilise(r.get(), posWrtRadial);
|
|
// heading-deg property below means bearing to txmitter; calc copied from navradio.cxx !!!
|
|
double bngToNavaid, az2, s;
|
|
SGGeodesy::inverse(posWrtRadial, (nav->geod()), bngToNavaid, az2, s);
|
|
// calc XTrack error
|
|
double xtkE = sin((CDITestRoll[i].rSele - CDITestRoll[i].onRose) * SG_DEGREES_TO_RADIANS) * (CDITestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
// Verify expected vs Result
|
|
string tMesg = itemDesc + "VOR type";
|
|
CPPUNIT_ASSERT_MESSAGE(tMesg, nav->type() == FGPositioned::VOR);
|
|
tMesg = itemDesc + "Operable";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vOpnl, node->getBoolValue("operable"));
|
|
tMesg = itemDesc + "TO Flag";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vToFlag, node->getBoolValue("to-flag"));
|
|
tMesg = itemDesc + "FROM Flag";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vToFlag, !node->getBoolValue("from-flag"));
|
|
//
|
|
tMesg = itemDesc + "nav-id";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, CDITestRoll[i].nvIden, string{node->getStringValue("nav-id")});
|
|
|
|
// Converting nvFreq to string results in trailing zeros
|
|
tMesg = itemDesc + "selected-mhz-fmt";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, formatFrequency(CDITestRoll[i].nvFreq), string{node->getStringValue("frequencies/selected-mhz-fmt")});
|
|
|
|
// actual-deg means: bearing seen on intstrument's dial: actual == onRose
|
|
tMesg = itemDesc + "actual-deg";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, CDITestRoll[i].onRose, node->getDoubleValue("radials/actual-deg"), CDITestRoll[i].vDefnTolr);
|
|
// heading-deg means true bearing to navaid, not affected by plane's heading
|
|
tMesg = itemDesc + "heading-deg";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, bngToNavaid, node->getDoubleValue("heading-deg"), 1);
|
|
//
|
|
tMesg = itemDesc + "Sig Norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vSigNorm, node->getDoubleValue("signal-quality-norm"), CDITestRoll[i].vSigTolr);
|
|
tMesg = itemDesc + "needle defl";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vHdgDefl, node->getDoubleValue("heading-needle-deflection"), CDITestRoll[i].vDeflTolr);
|
|
tMesg = itemDesc + "defl norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, CDITestRoll[i].vHdgNorm, node->getDoubleValue("heading-needle-deflection-norm"), CDITestRoll[i].vDefnTolr);
|
|
tMesg = itemDesc + "xTrack error";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xtkE, node->getDoubleValue("crosstrack-error-m"), CDITestRoll[i].xtkTolr);
|
|
}
|
|
}
|
|
|
|
static const struct {
|
|
int nvType;
|
|
double nvLat, nvLon, nvAlt, nvFreq, nvRnge, nvTwst;
|
|
const string& nvIden;
|
|
double onRose, atDstNM, atAltFt, atHdg, rSele;
|
|
bool vOpnl, vToFlag;
|
|
double vSigNorm, vSigTolr, vHdgDefl, vDeflTolr, vHdgNorm, vDefnTolr, xtkTolr;
|
|
const string& tDesc;
|
|
|
|
} ILSTestRoll[] = {
|
|
//
|
|
// Ref pilotscafe.com ILS width: 700ft wide at thrsh. WIthin range, sensed at +-35dg @ 10NM +-10dg @ 18NM
|
|
//
|
|
// Test Items: Add test cases here:
|
|
// nv<= fields are copied direct from nav dat => <= Rx pos wrt navaid, Radial => <= v- Values expected / tested => <= Item - Desc =>
|
|
//Typ Lat Lon Alt Freq Rnge TruHdng Iden] onRose atNm atAlt atHdg rSele Op To sigN - Tolr Defl - Tolr DNrm -Tolr xtkTol ]
|
|
//
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 117.932, 2.5, 2500, 27, 297.932, 1, 1, 1.0, 0.01, 0.0, 0.01, 0.0, 0.01, 50.0, "1: ISFO On LOC"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 116.932, 6.0, 1500, 27, 297.932, 1, 1, 1.0, 0.01, -1.0, 0.10, -0.1, 0.01, 50.0, "2: ISFO -1 Deg"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 118.932, 6.0, 1500, 27, 297.932, 1, 1, 1.0, 0.01, 1.0, 0.01, -0.1, 0.01, 50.0, "3: ISFO +1 Deg"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 113.932, 3.0, 600, 27, 297.932, 1, 1, 1.0, 0.01, -3.0, 0.10, -0.1, 0.01, 50.0, "4: ISFO < MinDefl"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 121.932, 3.0, 600, 27, 297.932, 1, 1, 1.0, 0.01, 3.0, 0.01, -0.1, 0.01, 50.0, "5: ISFO > MzxDefl"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 297.932, 4.0, 1500, 27, 297.932, 1, 1, 1.0, 0.01, 0.0, 0.01, 0.0, 0.01, 50.0, "6: ISFO BC On LOC"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 296.932, 4.0, 1500, 27, 297.932, 1, 1, 1.0, 0.01, 1.0, 0.10, -0.1, 0.01, 50.0, "7: ISFO BC -1 Deg"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 298.932, 4.0, 1500, 27, 297.932, 1, 1, 1.0, 0.01, -1.0, 0.01, -0.1, 0.01, 50.0, "8: ISFO BC +1 Deg"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 293.932, 4.0, 1500, 27, 297.932, 1, 1, 1.0, 0.01, 3.0, 0.10, -0.1, 0.01, 50.0, "9: ISFO BC > MaxD"}, //
|
|
{4, 37.626, -122.394, 8, 109.55, 18, 297.932, "ISFO", 301.932, 4.0, 1500, 27, 297.932, 1, 1, 1.0, 0.01, -3.0, 0.01, -0.1, 0.01, 50.0, "10: ISFO BC < MinD"} //
|
|
};
|
|
|
|
void NavRadioTests::callNavRadioILS()
|
|
{
|
|
// set flag for newnavradio
|
|
fgSetBool("/instrumentation/use-new-navradio", false);
|
|
// setup
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
r->bind();
|
|
r->init();
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
// needed for the radio to power up
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
//
|
|
int tale = sizeof(ILSTestRoll) / sizeof(ILSTestRoll[0]);
|
|
for (int i = 0; (i < tale); i++) {
|
|
// prep error message
|
|
const string& itemDesc = " navRadioILS Item " + ILSTestRoll[i].tDesc + " @ ";
|
|
// Txmitting navaid
|
|
node->setDoubleValue("frequencies/selected-mhz", ILSTestRoll[i].nvFreq);
|
|
node->setDoubleValue("radials/selected-deg", ILSTestRoll[i].rSele);
|
|
FGPositioned::TypeFilter f{{FGPositioned::VOR, FGPositioned::ILS, FGPositioned::LOC}};
|
|
FGNavRecordRef nav = fgpositioned_cast<FGNavRecord>(FGPositioned::findClosestWithIdent(ILSTestRoll[i].nvIden,
|
|
SGGeod::fromDeg(ILSTestRoll[i].nvLon, ILSTestRoll[i].nvLat), &f));
|
|
SGGeod posWrtRadial = SGGeodesy::direct(nav->geod(), (ILSTestRoll[i].onRose), (ILSTestRoll[i].atDstNM * SG_NM_TO_METER));
|
|
posWrtRadial.setElevationFt(ILSTestRoll[i].atAltFt);
|
|
setPositionAndStabilise(r.get(), posWrtRadial);
|
|
// heading-deg property below means bearing to txmitter; calc copied from navradio.cxx !!!
|
|
double bngToNavaid, az2, s;
|
|
SGGeodesy::inverse(posWrtRadial, (nav->geod()), bngToNavaid, az2, s);
|
|
double xtkE = sin((ILSTestRoll[i].rSele - ILSTestRoll[i].onRose) * SG_DEGREES_TO_RADIANS) * (ILSTestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
//
|
|
const double locWidth = nav->localizerWidth();
|
|
// Expected Defl / Scaling is hokey because ILS width varies ??
|
|
const double deflectionScale = 20.0 / locWidth; // 20 degrees is full VOR swing (-10 to +10 degrees)
|
|
double xpecDefl = (ILSTestRoll[i].vHdgDefl * deflectionScale);
|
|
xpecDefl = (xpecDefl > 10) ? 10 : xpecDefl;
|
|
xpecDefl = (xpecDefl < -10) ? -10 : xpecDefl;
|
|
//
|
|
// Verify expected: Operational and To flags
|
|
string tMesg = itemDesc + "ILS type";
|
|
CPPUNIT_ASSERT_MESSAGE(tMesg, nav->type() == FGPositioned::ILS);
|
|
tMesg = itemDesc + "Operable";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, ILSTestRoll[i].vOpnl, node->getBoolValue("operable"));
|
|
tMesg = itemDesc + "TO Flag";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, ILSTestRoll[i].vToFlag, node->getBoolValue("to-flag"));
|
|
tMesg = itemDesc + "FROM Flag";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, ILSTestRoll[i].vToFlag, !node->getBoolValue("from-flag"));
|
|
//
|
|
tMesg = itemDesc + "heading-deg";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, bngToNavaid, node->getDoubleValue("heading-deg"), 1);
|
|
tMesg = itemDesc + "nav-id";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, ILSTestRoll[i].nvIden, string{node->getStringValue("nav-id")});
|
|
// Converting nvFreq to string results in trailing zeros
|
|
tMesg = itemDesc + "selected-mhz-fmt";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, formatFrequency(ILSTestRoll[i].nvFreq), string{node->getStringValue("frequencies/selected-mhz-fmt")});
|
|
|
|
// actual-deg means: bearing seen on intstrument's dial: actual == onRose
|
|
tMesg = itemDesc + "actual-deg";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, ILSTestRoll[i].onRose, node->getDoubleValue("radials/actual-deg"), ILSTestRoll[i].vDefnTolr);
|
|
tMesg = itemDesc + "Sig Norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, ILSTestRoll[i].vSigNorm, node->getDoubleValue("signal-quality-norm"), ILSTestRoll[i].vSigTolr);
|
|
tMesg = itemDesc + "needle defl";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xpecDefl, node->getDoubleValue("heading-needle-deflection"), ILSTestRoll[i].vDeflTolr);
|
|
tMesg = itemDesc + "defl norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, (xpecDefl * 0.1), node->getDoubleValue("heading-needle-deflection-norm"), ILSTestRoll[i].vDefnTolr);
|
|
tMesg = itemDesc + "xTrack error";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xtkE, node->getDoubleValue("crosstrack-error-m"), ILSTestRoll[i].xtkTolr);
|
|
}
|
|
}
|
|
|
|
void NavRadioTests::callNewNavRadioILS()
|
|
{
|
|
// set flag for newnavradio
|
|
fgSetBool("/instrumentation/use-new-navradio", true);
|
|
// setup
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
r->bind();
|
|
r->init();
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
// needed for the radio to power up
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
//
|
|
int tale = sizeof(ILSTestRoll) / sizeof(ILSTestRoll[0]);
|
|
for (int i = 0; (i < tale); i++) {
|
|
// prep error message
|
|
const string & itemDesc = "newNavRadioILS Item " + ILSTestRoll[i].tDesc + " @ ";
|
|
// Txmitting navaid
|
|
node->setDoubleValue("frequencies/selected-mhz", ILSTestRoll[i].nvFreq);
|
|
node->setDoubleValue("radials/selected-deg", ILSTestRoll[i].rSele);
|
|
FGPositioned::TypeFilter f{{FGPositioned::VOR, FGPositioned::ILS, FGPositioned::LOC}};
|
|
FGNavRecordRef nav = fgpositioned_cast<FGNavRecord>(FGPositioned::findClosestWithIdent(ILSTestRoll[i].nvIden, \
|
|
SGGeod::fromDeg( ILSTestRoll[i].nvLon, ILSTestRoll[i].nvLat), &f));
|
|
SGGeod posWrtRadial = SGGeodesy::direct(nav->geod(), (ILSTestRoll[i].onRose ), (ILSTestRoll[i].atDstNM * SG_NM_TO_METER));
|
|
posWrtRadial.setElevationFt(ILSTestRoll[i].atAltFt);
|
|
setPositionAndStabilise(r.get(), posWrtRadial);
|
|
// heading-deg property below means bearing to txmitter; calc copied from navradio.cxx !!!
|
|
double bngToNavaid, az2, s;
|
|
SGGeodesy::inverse(posWrtRadial, (nav->geod()), bngToNavaid, az2, s);
|
|
double xtkE = sin( (ILSTestRoll[i].rSele - ILSTestRoll[i].onRose) * SG_DEGREES_TO_RADIANS) \
|
|
* ( ILSTestRoll[i].atDstNM * SG_NM_TO_METER ) ;
|
|
//
|
|
const double locWidth = nav->localizerWidth();
|
|
// Expected Defl / Scaling is hokey because ILS width varies ??
|
|
const double deflectionScale = 20.0 / locWidth; // 20 degrees is full VOR swing (-10 to +10 degrees)
|
|
double xpecDefl = (ILSTestRoll[i].vHdgDefl * deflectionScale);
|
|
xpecDefl = ( xpecDefl > 10 ) ? 10 : xpecDefl;
|
|
xpecDefl = ( xpecDefl < -10 ) ? -10 : xpecDefl;
|
|
//
|
|
// Verify expected: Operational and To flags
|
|
string tMesg = itemDesc + "ILS type";
|
|
CPPUNIT_ASSERT_MESSAGE( tMesg, nav->type() == FGPositioned::ILS);
|
|
tMesg = itemDesc + "Operable";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE( tMesg, ILSTestRoll[i].vOpnl, node->getBoolValue("operable"));
|
|
tMesg = itemDesc + "TO Flag";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE( tMesg, ILSTestRoll[i].vToFlag, node->getBoolValue("to-flag"));
|
|
tMesg = itemDesc + "FROM Flag";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE( tMesg, ILSTestRoll[i].vToFlag, !node->getBoolValue("from-flag"));
|
|
//
|
|
tMesg = itemDesc + "heading-deg";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE( tMesg, bngToNavaid, node->getDoubleValue("heading-deg"), 1);
|
|
tMesg = itemDesc + "nav-id";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE( tMesg, ILSTestRoll[i].nvIden, string{node->getStringValue("nav-id")});
|
|
// Converting nvFreq to string results in trailing zeros
|
|
tMesg = itemDesc + "selected-mhz-fmt";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, formatFrequency(ILSTestRoll[i].nvFreq), string{node->getStringValue("frequencies/selected-mhz-fmt")});
|
|
// actual-deg means: bearing seen on intstrument's dial: actual == onRose
|
|
tMesg = itemDesc + "actual-deg";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE( tMesg, ILSTestRoll[i].onRose, node->getDoubleValue("radials/actual-deg"), ILSTestRoll[i].vDefnTolr);
|
|
tMesg = itemDesc + "Sig Norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE( tMesg, ILSTestRoll[i].vSigNorm, node->getDoubleValue("signal-quality-norm"), ILSTestRoll[i].vSigTolr);
|
|
tMesg = itemDesc + "needle defl";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE( tMesg, xpecDefl, node->getDoubleValue("heading-needle-deflection"), ILSTestRoll[i].vDeflTolr);
|
|
tMesg = itemDesc + "defl norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE( tMesg, (xpecDefl * 0.1 ), node->getDoubleValue("heading-needle-deflection-norm"), ILSTestRoll[i].vDefnTolr);
|
|
tMesg = itemDesc + "xTrack error";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE( tMesg, xtkE, node->getDoubleValue("crosstrack-error-m"), ILSTestRoll[i].xtkTolr);
|
|
}
|
|
}
|
|
|
|
static const struct {
|
|
int nvType;
|
|
double nvLat, nvLon, nvAlt, nvFreq, nvRnge, nvAzim;
|
|
const string& nvIden;
|
|
double onRose, atDstNM, atAltFt, plusDeg, atHdg, rTruDeg;
|
|
bool vInRnge, vFalse;
|
|
double vSigNorm, vSigTolr, vGSDefl, vDeflTolr, vGSDefn, vDefnTolr;
|
|
const string& tDesc;
|
|
} GSTestRoll[] = {
|
|
//
|
|
// Test Items: Add test cases here:
|
|
// nv<= fields are copied direct from nav dat => <= Rx pos wrt navaid, Radial => <= v- Values expected / tested => <= Item - Desc =>
|
|
//Typ Lat Lon Alt Freq Rnge GSAzim Iden] onRose atNm atAlt or Deg atHdg TruDeg Rng Fls SgN - Tolr GSDefl-Tolr GSDefn-Tolr ]
|
|
//
|
|
{ 4, 52.563, 13.305, 101, 110.10, 10, 3.000, "ITLW", 117.932, 8.0, 0, 0, 80.828, 260.857, 1, 0, 1.0, 0.01, 0.0, 0.1, 0.0, 0.01, "1: EDDT 26R +0 deg" }, //
|
|
{ 4, 52.563, 13.305, 101, 110.10, 10, 3.000, "ITLW", 117.932, 4.0, 0, 0.50, 80.828, 260.857, 1, 0, 1.0, 0.01, 0.0, 0.1, 0.0, 0.01, "2: EDDT 26R +0.5 d" }, //
|
|
{ 4, 52.563, 13.305, 101, 110.10, 10, 3.000, "ITLW", 117.932, 2.0, 0, -1.00, 80.828, 260.857, 1, 0, 1.0, 0.01, 0.0, 0.1, 0.0, 0.01, "3: EDDT 26R -1 deg" }, //
|
|
{ 4, 52.563, 13.305, 101, 110.10, 10, 3.000, "ITLW", 117.932, 5.0, 0, 3.00, 80.828, 260.857, 1, 1, 1.0, 0.01, 0.0, 0.1, 0.0, 0.01, "4: EDDT 26R +3.0 Fls"}, //
|
|
{ 4, 52.563, 13.305, 101, 110.10, 10, 3.000, "ITLW", 117.932, 3.0, 0, +2.65, 80.828, 260.857, 1, 1, 1.0, 0.01,-1.75, 0.1, -0.5, 0.01, "5: EDDT 26R +3.5 Fls"}, //
|
|
// { 4, 51.464, -0.439, 50, 109.50, 10, 3.000, "ILL", 89.690, 7.5, 2500, 0, 80.828, 269.690, 1, 0, 1.0, 0.01, 0.0, 0.1, 0.0, 0.01, "6: EGLL 27L 2K5 7M5"}, // Fail: Rx finds IBB
|
|
// { 4, 51.464, -0.439, 50, 109.50, 10, 3.000, "ILL", 89.690, 9.0, 3000, 0, 80.828, 269.690, 1, 0, 1.0, 0.01, 0.0, 0.1, 0.0, 0.01, "7: EGLL 27L 3K0 9M0"}, //
|
|
// { 4, 51.464, -0.439, 50, 109.50, 10, 3.000, "ILL", 89.690,17.5, 4000, 0, 80.828, 269.690, 1, 0, 1.0, 0.01, 0.0, 0.1, 0.0, 0.01, "8: EGLL 27L 4K 17M5"}, //
|
|
// { 4, 51.464, -0.439, 50, 109.50, 10, 3.000, "ILL", 89.690,25.0, 4000, 0, 80.828, 269.690, 1, 0, 1.0, 0.01, 0.0, 0.1, 0.0, 0.01, "9: EGLL 27L 4K 25M0"} //
|
|
};
|
|
|
|
void NavRadioTests::callNavRadioGS() {
|
|
//set flag for newnavradio
|
|
fgSetBool("/instrumentation/use-new-navradio", false);
|
|
// setup
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
r->bind();
|
|
r->init();
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
// needed for the radio to power up
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
//
|
|
// GS beam depth +-0.7deg; needle deflection -+3.5; gs-direct: Rxvr elevation from GS Txmitter level
|
|
//
|
|
const double halfBeam = 0.700;
|
|
const double deflFact = 3.500;
|
|
//
|
|
int tale = sizeof(GSTestRoll) / sizeof(GSTestRoll[0]);
|
|
for (int i = 0; (i < tale); i++) {
|
|
// prep error message
|
|
const string& itemDesc = " navRadioGS Item " + GSTestRoll[i].tDesc + " @ ";
|
|
// Txmitting navaid
|
|
node->setDoubleValue("frequencies/selected-mhz", GSTestRoll[i].nvFreq);
|
|
node->setDoubleValue("radials/selected-deg", GSTestRoll[i].rTruDeg);
|
|
FGPositioned::TypeFilter f{{FGPositioned::VOR, FGPositioned::GS, FGPositioned::LOC}};
|
|
FGNavRecordRef nav = fgpositioned_cast<FGNavRecord>(FGPositioned::findClosestWithIdent(GSTestRoll[i].nvIden,
|
|
SGGeod::fromDeg(GSTestRoll[i].nvLon, GSTestRoll[i].nvLat), &f));
|
|
|
|
// Check for proper nav type befor doing GS things
|
|
string tMesg = itemDesc + "GS Type ?";
|
|
CPPUNIT_ASSERT_MESSAGE(tMesg, nav->type() == FGPositioned::GS);
|
|
/////////////
|
|
// derive the GS geometry in cartesian vectors, to match what navradio.cxx does
|
|
SGGeod aboveGS = nav->geod();
|
|
aboveGS.setElevationM(nav->geod().getElevationM() + 100);
|
|
SGVec3d gsVerticalAxis = SGVec3d::fromGeod(aboveGS) - nav->cart();
|
|
// intentionally different approach to what navradio uses
|
|
gsVerticalAxis *= 0.01; // make it per meter, since we used 100m above
|
|
// derive the baseline
|
|
SGQuatd baseLineRot = SGQuatd::fromLonLat(nav->geod()) * SGQuatd::fromHeadAttBankDeg(GSTestRoll[i].atHdg, 0, 0);
|
|
SGVec3d gsAltAxis = baseLineRot.backTransform(SGVec3d(1.0, 0.0, 0.0));
|
|
const SGVec3d gsCart = nav->cart();
|
|
//////////////////
|
|
// expected deflection is calculated here if atAltFt is non-zero
|
|
double xpecAzim, xpecDefl, xpecDefn;
|
|
double bngToNavaid, az2, s;
|
|
if (GSTestRoll[i].atAltFt == 0) {
|
|
// Line item atAlt is zero so use degrees off GlideSlope for Rx position
|
|
double gsAngleRad = (nav->glideSlopeAngleDeg() + GSTestRoll[i].plusDeg) * SG_DEGREES_TO_RADIANS;
|
|
SGVec3d radioPos = gsCart;
|
|
radioPos += (gsVerticalAxis * tan(gsAngleRad) * GSTestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
radioPos += (gsAltAxis * GSTestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
setPositionAndStabilise(r.get(), SGGeod::fromCart(radioPos));
|
|
xpecAzim = (GSTestRoll[i].nvAzim + GSTestRoll[i].plusDeg);
|
|
} else {
|
|
// Line item atAlt is non zero so use altitude for Rx position
|
|
SGGeod p = SGGeodesy::direct(nav->geod(), GSTestRoll[i].atAltFt, GSTestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
p.setElevationFt(GSTestRoll[i].atAltFt);
|
|
setPositionAndStabilise(r.get(), p);
|
|
//tbd calc Rx Azim from Tx for altitude case
|
|
SGGeodesy::inverse(p, nav->geod(), bngToNavaid, az2, s);
|
|
xpecAzim = SG_RADIANS_TO_DEGREES * (atan((GSTestRoll[i].atAltFt * SG_FEET_TO_METER) / s));
|
|
}
|
|
//
|
|
if (GSTestRoll[i].vFalse) {
|
|
// rxFlse indicates false signal, use deflections manually entered in Item
|
|
xpecDefl = GSTestRoll[i].vGSDefl;
|
|
xpecDefn = GSTestRoll[i].vGSDefn;
|
|
} else {
|
|
if (GSTestRoll[i].atAltFt == 0) {
|
|
// not rxFlse and atAltFt is zero : calculate needle deflections from Rx posn degrees wrt beam
|
|
xpecDefn = 0 - GSTestRoll[i].plusDeg / halfBeam; // Plane high: needle below
|
|
} else {
|
|
// not rxFlse and atAltFt non zero : calculate needle deflections from Rx posn azimuth wrt beam
|
|
xpecDefn = (GSTestRoll[i].nvAzim - az2) / halfBeam; // Plane high: needle below;
|
|
}
|
|
xpecDefn = (xpecDefn > 1) ? 1 : xpecDefn;
|
|
xpecDefn = (xpecDefn < -1) ? -1 : xpecDefn;
|
|
xpecDefl = xpecDefn * deflFact;
|
|
}
|
|
//
|
|
// Verify expected:
|
|
tMesg = itemDesc + "Operable";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, GSTestRoll[i].vInRnge, node->getBoolValue("operable"));
|
|
tMesg = itemDesc + "nav-id";
|
|
string dddbug = node->getStringValue("nav-id");
|
|
CPPUNIT_ASSERT_MESSAGE(tMesg, !strcmp((GSTestRoll[i].nvIden).c_str(), node->getStringValue("nav-id")));
|
|
tMesg = itemDesc + "Sig Norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, GSTestRoll[i].vSigNorm, node->getDoubleValue("signal-quality-norm"), GSTestRoll[i].vSigTolr);
|
|
tMesg = itemDesc + "gs-direct";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xpecAzim, node->getDoubleValue("gs-direct-deg"), 1);
|
|
tMesg = itemDesc + "needle defl";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xpecDefl, node->getDoubleValue("gs-needle-deflection"), GSTestRoll[i].vDeflTolr);
|
|
tMesg = itemDesc + "defl norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xpecDefn, node->getDoubleValue("gs-needle-deflection-norm"), GSTestRoll[i].vDefnTolr);
|
|
//
|
|
}
|
|
}
|
|
|
|
void NavRadioTests::callNewNavRadioGS()
|
|
{
|
|
//set flag for newnavradio
|
|
fgSetBool("/instrumentation/use-new-navradio", true);
|
|
// setup
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
r->bind();
|
|
r->init();
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
// needed for the radio to power up
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
//
|
|
// GS beam depth +-0.7deg; needle deflection -+3.5; gs-direct: Rxvr elevation from GS Txmitter level
|
|
//
|
|
const double halfBeam = 0.700;
|
|
const double deflFact = 3.500;
|
|
//
|
|
int tale = sizeof(GSTestRoll) / sizeof(GSTestRoll[0]);
|
|
for (int i = 0; (i < tale); i++) {
|
|
// prep error message
|
|
const string& itemDesc = "newnavRadioGS Item " + GSTestRoll[i].tDesc + " @ ";
|
|
// Txmitting navaid
|
|
node->setDoubleValue("frequencies/selected-mhz", GSTestRoll[i].nvFreq);
|
|
node->setDoubleValue("radials/selected-deg", GSTestRoll[i].rTruDeg);
|
|
FGPositioned::TypeFilter f{{FGPositioned::VOR, FGPositioned::GS, FGPositioned::LOC}};
|
|
FGNavRecordRef nav = fgpositioned_cast<FGNavRecord>(FGPositioned::findClosestWithIdent(GSTestRoll[i].nvIden,
|
|
SGGeod::fromDeg(GSTestRoll[i].nvLon, GSTestRoll[i].nvLat), &f));
|
|
|
|
// Check for proper nav type befor doing GS things
|
|
string tMesg = itemDesc + "GS Type ?";
|
|
CPPUNIT_ASSERT_MESSAGE(tMesg, nav->type() == FGPositioned::GS);
|
|
/////////////
|
|
// derive the GS geometry in cartesian vectors, to match what navradio.cxx does
|
|
SGGeod aboveGS = nav->geod();
|
|
aboveGS.setElevationM(nav->geod().getElevationM() + 100);
|
|
SGVec3d gsVerticalAxis = SGVec3d::fromGeod(aboveGS) - nav->cart();
|
|
// intentionally different approach to what navradio uses
|
|
gsVerticalAxis *= 0.01; // make it per meter, since we used 100m above
|
|
// derive the baseline
|
|
SGQuatd baseLineRot = SGQuatd::fromLonLat(nav->geod()) * SGQuatd::fromHeadAttBankDeg(GSTestRoll[i].atHdg, 0, 0);
|
|
SGVec3d gsAltAxis = baseLineRot.backTransform(SGVec3d(1.0, 0.0, 0.0));
|
|
const SGVec3d gsCart = nav->cart();
|
|
//////////////////
|
|
// expected deflection is calculated here if atAltFt is non-zero
|
|
double xpecAzim, xpecDefl, xpecDefn;
|
|
double bngToNavaid, az2, s;
|
|
if (GSTestRoll[i].atAltFt == 0) {
|
|
// Line item atAlt is zero so use degrees off GlideSlope for Rx position
|
|
double gsAngleRad = (nav->glideSlopeAngleDeg() + GSTestRoll[i].plusDeg) * SG_DEGREES_TO_RADIANS;
|
|
SGVec3d radioPos = gsCart;
|
|
radioPos += (gsVerticalAxis * tan(gsAngleRad) * GSTestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
radioPos += (gsAltAxis * GSTestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
setPositionAndStabilise(r.get(), SGGeod::fromCart(radioPos));
|
|
xpecAzim = (GSTestRoll[i].nvAzim + GSTestRoll[i].plusDeg);
|
|
} else {
|
|
// Line item atAlt is non zero so use altitude for Rx position
|
|
SGGeod p = SGGeodesy::direct(nav->geod(), GSTestRoll[i].atAltFt, GSTestRoll[i].atDstNM * SG_NM_TO_METER);
|
|
p.setElevationFt(GSTestRoll[i].atAltFt);
|
|
setPositionAndStabilise(r.get(), p);
|
|
//tbd calc Rx Azim from Tx for altitude case
|
|
SGGeodesy::inverse(p, nav->geod(), bngToNavaid, az2, s);
|
|
xpecAzim = SG_RADIANS_TO_DEGREES * (atan((GSTestRoll[i].atAltFt * SG_FEET_TO_METER) / s));
|
|
}
|
|
//
|
|
if (GSTestRoll[i].vFalse) {
|
|
// rxFlse indicates false signal, use deflections manually entered in Item
|
|
xpecDefl = GSTestRoll[i].vGSDefl;
|
|
xpecDefn = GSTestRoll[i].vGSDefn;
|
|
} else {
|
|
if (GSTestRoll[i].atAltFt == 0) {
|
|
// not rxFlse and atAltFt is zero : calculate needle deflections from Rx posn degrees wrt beam
|
|
xpecDefn = 0 - GSTestRoll[i].plusDeg / halfBeam; // Plane high: needle below
|
|
} else {
|
|
// not rxFlse and atAltFt non zero : calculate needle deflections from Rx posn azimuth wrt beam
|
|
xpecDefn = (GSTestRoll[i].nvAzim - az2) / halfBeam; // Plane high: needle below;
|
|
}
|
|
xpecDefn = (xpecDefn > 1) ? 1 : xpecDefn;
|
|
xpecDefn = (xpecDefn < -1) ? -1 : xpecDefn;
|
|
xpecDefl = xpecDefn * deflFact;
|
|
}
|
|
//
|
|
// Verify expected:
|
|
tMesg = itemDesc + "Operable";
|
|
CPPUNIT_ASSERT_EQUAL_MESSAGE(tMesg, GSTestRoll[i].vInRnge, node->getBoolValue("operable"));
|
|
tMesg = itemDesc + "nav-id";
|
|
string dddbug = node->getStringValue("nav-id");
|
|
CPPUNIT_ASSERT_MESSAGE(tMesg, !strcmp((GSTestRoll[i].nvIden).c_str(), node->getStringValue("nav-id")));
|
|
tMesg = itemDesc + "Sig Norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, GSTestRoll[i].vSigNorm, node->getDoubleValue("signal-quality-norm"), GSTestRoll[i].vSigTolr);
|
|
tMesg = itemDesc + "gs-direct";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xpecAzim, node->getDoubleValue("gs-direct-deg"), 1);
|
|
tMesg = itemDesc + "needle defl";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xpecDefl, node->getDoubleValue("gs-needle-deflection"), GSTestRoll[i].vDeflTolr);
|
|
tMesg = itemDesc + "defl norm";
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL_MESSAGE(tMesg, xpecDefn, node->getDoubleValue("gs-needle-deflection-norm"), GSTestRoll[i].vDefnTolr);
|
|
//
|
|
}
|
|
}
|
|
|
|
void NavRadioTests::testGS()
|
|
{
|
|
// radio setup
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
r->bind();
|
|
r->init();
|
|
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
|
|
// EDDT 28R
|
|
FGPositioned::TypeFilter f{FGPositioned::GS};
|
|
FGNavRecordRef gs = fgpositioned_cast<FGNavRecord>(
|
|
FGPositioned::findClosestWithIdent("ITLW", SGGeod::fromDeg(13, 52), &f));
|
|
CPPUNIT_ASSERT(gs->type() == FGPositioned::GS);
|
|
node->setDoubleValue("frequencies/selected-mhz", 110.10);
|
|
CPPUNIT_ASSERT(!strcmp("110.10", node->getStringValue("frequencies/selected-mhz-fmt")));
|
|
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(gs->glideSlopeAngleDeg(), 3.0, 0.001);
|
|
double gsAngleRad = gs->glideSlopeAngleDeg() * SG_DEGREES_TO_RADIANS;
|
|
|
|
/////////////
|
|
// derive the GS geometry in cartesian vectors, to match what
|
|
// navradio.cxx does
|
|
SGGeod aboveGS = gs->geod();
|
|
aboveGS.setElevationM(gs->geod().getElevationM() + 100.0);
|
|
SGVec3d gsVerticalAxis = SGVec3d::fromGeod(aboveGS) - gs->cart();
|
|
// intentionally different approach to what navradio uses
|
|
|
|
gsVerticalAxis *= 0.01; // make it per meter, since we used 100m above
|
|
|
|
// dervice the baseline
|
|
SGQuatd baseLineRot = SGQuatd::fromLonLat(gs->geod()) * SGQuatd::fromHeadAttBankDeg(80.828, 0, 0);
|
|
SGVec3d gsAltAxis = baseLineRot.backTransform(SGVec3d(1.0, 0.0, 0.0));
|
|
|
|
const SGVec3d gsCart = gs->cart();
|
|
|
|
//////////////////
|
|
|
|
SGVec3d radioPos = gsCart;
|
|
radioPos += (gsVerticalAxis * tan(gsAngleRad) * 8 * SG_NM_TO_METER);
|
|
radioPos += (gsAltAxis * 8 * SG_NM_TO_METER);
|
|
|
|
setPositionAndStabilise(r.get(), SGGeod::fromCart(radioPos));
|
|
|
|
CPPUNIT_ASSERT(!strcmp("ITLW", node->getStringValue("nav-id")));
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(1.0, node->getDoubleValue("signal-quality-norm"), 0.01);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(3.0, node->getDoubleValue("gs-direct-deg"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(0.0, node->getDoubleValue("gs-needle-deflection"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(0.0, node->getDoubleValue("gs-needle-deflection-norm"), 0.01);
|
|
CPPUNIT_ASSERT(node->getBoolValue("gs-in-range"));
|
|
|
|
// 0.5 degree offset above
|
|
gsAngleRad = (gs->glideSlopeAngleDeg() + 0.5) * SG_DEGREES_TO_RADIANS;
|
|
radioPos = gsCart;
|
|
radioPos += (gsVerticalAxis * tan(gsAngleRad) * 4 * SG_NM_TO_METER);
|
|
radioPos += (gsAltAxis * 4 * SG_NM_TO_METER);
|
|
|
|
setPositionAndStabilise(r.get(), SGGeod::fromCart(radioPos));
|
|
|
|
CPPUNIT_ASSERT(!strcmp("ITLW", node->getStringValue("nav-id")));
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(1.0, node->getDoubleValue("signal-quality-norm"), 0.01);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(3.5, node->getDoubleValue("gs-direct-deg"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(-2.5, node->getDoubleValue("gs-needle-deflection"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(-0.714, node->getDoubleValue("gs-needle-deflection-norm"), 0.01);
|
|
CPPUNIT_ASSERT(node->getBoolValue("gs-in-range"));
|
|
|
|
// 1 degree below (danger!)
|
|
gsAngleRad = (gs->glideSlopeAngleDeg() - 1.0) * SG_DEGREES_TO_RADIANS;
|
|
radioPos = gsCart;
|
|
radioPos += (gsVerticalAxis * tan(gsAngleRad) * 2 * SG_NM_TO_METER);
|
|
radioPos += (gsAltAxis * 2 * SG_NM_TO_METER);
|
|
|
|
setPositionAndStabilise(r.get(), SGGeod::fromCart(radioPos));
|
|
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(1.0, node->getDoubleValue("signal-quality-norm"), 0.01);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(2.0, node->getDoubleValue("gs-direct-deg"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(3.5, node->getDoubleValue("gs-needle-deflection"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(1.0, node->getDoubleValue("gs-needle-deflection-norm"), 0.01);
|
|
CPPUNIT_ASSERT(node->getBoolValue("gs-in-range"));
|
|
|
|
// false course above, reversed
|
|
gsAngleRad = (gs->glideSlopeAngleDeg() + 3.0) * SG_DEGREES_TO_RADIANS;
|
|
radioPos = gsCart;
|
|
radioPos += (gsVerticalAxis * tan(gsAngleRad) * 5 * SG_NM_TO_METER);
|
|
radioPos += (gsAltAxis * 5 * SG_NM_TO_METER);
|
|
|
|
setPositionAndStabilise(r.get(), SGGeod::fromCart(radioPos));
|
|
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(1.0, node->getDoubleValue("signal-quality-norm"), 0.01);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(6.0, node->getDoubleValue("gs-direct-deg"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(0.0, node->getDoubleValue("gs-needle-deflection"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(0.0, node->getDoubleValue("gs-needle-deflection-norm"), 0.01);
|
|
CPPUNIT_ASSERT(node->getBoolValue("gs-in-range"));
|
|
|
|
// false course above, reversed, 0.35 offset below
|
|
gsAngleRad = (gs->glideSlopeAngleDeg() + 2.65) * SG_DEGREES_TO_RADIANS;
|
|
radioPos = gsCart;
|
|
radioPos += (gsVerticalAxis * tan(gsAngleRad) * 3 * SG_NM_TO_METER);
|
|
radioPos += (gsAltAxis * 3 * SG_NM_TO_METER);
|
|
|
|
setPositionAndStabilise(r.get(), SGGeod::fromCart(radioPos));
|
|
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(1.0, node->getDoubleValue("signal-quality-norm"), 0.01);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(5.65, node->getDoubleValue("gs-direct-deg"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(-1.75, node->getDoubleValue("gs-needle-deflection"), 0.1);
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(-0.5, node->getDoubleValue("gs-needle-deflection-norm"), 0.01);
|
|
CPPUNIT_ASSERT(node->getBoolValue("gs-in-range"));
|
|
}
|
|
|
|
void NavRadioTests::testILSFalseCourse()
|
|
{
|
|
|
|
// also GS false lobes
|
|
}
|
|
|
|
void NavRadioTests::testILSPaired()
|
|
{
|
|
// EGPH and countless more
|
|
}
|
|
|
|
void NavRadioTests::testILSAdjacentPaired()
|
|
{
|
|
// eg KJFK
|
|
}
|
|
|
|
void NavRadioTests::testGlideslopeLongDistance()
|
|
{
|
|
// radio setup
|
|
SGPropertyNode_ptr configNode(new SGPropertyNode);
|
|
configNode->setStringValue("name", "navtest");
|
|
configNode->setIntValue("number", 2);
|
|
std::unique_ptr<FGNavRadio> r(new FGNavRadio(configNode));
|
|
r->bind();
|
|
r->init();
|
|
|
|
SGPropertyNode_ptr node = globals->get_props()->getNode("instrumentation/navtest[2]");
|
|
node->setBoolValue("serviceable", true);
|
|
globals->get_props()->setDoubleValue("systems/electrical/outputs/nav", 6.0);
|
|
|
|
// EGLL 27L
|
|
FGPositioned::TypeFilter f{FGPositioned::GS};
|
|
FGNavRecordRef gs = fgpositioned_cast<FGNavRecord>(
|
|
FGPositioned::findClosestWithIdent("ILL", SGGeod::fromDeg(0, 51), &f));
|
|
CPPUNIT_ASSERT(gs->type() == FGPositioned::GS);
|
|
node->setDoubleValue("frequencies/selected-mhz", 109.50);
|
|
CPPUNIT_ASSERT(!strcmp("109.50", node->getStringValue("frequencies/selected-mhz-fmt")));
|
|
|
|
CPPUNIT_ASSERT_DOUBLES_EQUAL(gs->glideSlopeAngleDeg(), 3.0, 0.001);
|
|
double gsAngleRad = gs->glideSlopeAngleDeg() * SG_DEGREES_TO_RADIANS;
|
|
|
|
// standard approach (per charts)
|
|
SGGeod p = SGGeodesy::direct(gs->geod(), 90, 7.5 * SG_NM_TO_METER);
|
|
p.setElevationFt(2500);
|
|
setPositionAndStabilise(r.get(), p);
|
|
CPPUNIT_ASSERT_EQUAL(true, node->getBoolValue("gs-in-range"));
|
|
|
|
// normal approach
|
|
p = SGGeodesy::direct(gs->geod(), 90, 9 * SG_NM_TO_METER);
|
|
p.setElevationFt(3000);
|
|
setPositionAndStabilise(r.get(), p);
|
|
CPPUNIT_ASSERT_EQUAL(true, node->getBoolValue("gs-in-range"));
|
|
|
|
// in our current nav data, the GS range is defined as 10nm, so the gs-in-range
|
|
// is false for these
|
|
|
|
// 4000 feet intercept
|
|
p = SGGeodesy::direct(gs->geod(), 90, 12 * SG_NM_TO_METER);
|
|
p.setElevationFt(4000);
|
|
setPositionAndStabilise(r.get(), p);
|
|
CPPUNIT_ASSERT_EQUAL(false, node->getBoolValue("gs-in-range"));
|
|
CPPUNIT_ASSERT_EQUAL(true, node->getBoolValue("in-range"));
|
|
|
|
// further back
|
|
p = SGGeodesy::direct(gs->geod(), 90, 17.5 * SG_NM_TO_METER);
|
|
p.setElevationFt(4000);
|
|
setPositionAndStabilise(r.get(), p);
|
|
CPPUNIT_ASSERT_EQUAL(false, node->getBoolValue("gs-in-range"));
|
|
CPPUNIT_ASSERT_EQUAL(true, node->getBoolValue("in-range"));
|
|
|
|
// really pushing it
|
|
p = SGGeodesy::direct(gs->geod(), 90, 25 * SG_NM_TO_METER);
|
|
p.setElevationFt(4000);
|
|
setPositionAndStabilise(r.get(), p);
|
|
CPPUNIT_ASSERT_EQUAL(false, node->getBoolValue("gs-in-range"));
|
|
CPPUNIT_ASSERT_EQUAL(true, node->getBoolValue("in-range"));
|
|
}
|