GeoTest.cc 2.21 KB
Newer Older
1 2 3 4 5 6 7 8
/****************************************************************************
 *
 *   (c) 2009-2016 QGROUNDCONTROL PROJECT <http://www.qgroundcontrol.org>
 *
 * QGroundControl is licensed according to the terms in the file
 * COPYING.md in the root of the source code directory.
 *
 ****************************************************************************/
9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25


/// @file
///     @brief Unit test fpr QGCGeo coordinate project math.
///
///     @author David Goodman <dagoodma@gmail.com>

#include "GeoTest.h"
#include "QGCGeo.h"

/*
GeoTest::GeoTest(void)
{

}
*/

26
void GeoTest::_convertGeoToNed_test(void)
27 28 29 30 31 32 33 34
{
    QGeoCoordinate coord(47.364869, 8.594398, 0.0);

    double expectedX = -1281.152128182419801305514;
    double expectedY = 3486.949719522415307437768;
    double expectedZ = 0;

    double x, y, z;
35
    convertGeoToNed(coord, _origin, &x, &y, &z);
36 37 38 39 40 41

    QCOMPARE(x, expectedX);
    QCOMPARE(y, expectedY);
    QCOMPARE(z, expectedZ);
}

42
void GeoTest::_convertGeoToNedAtOrigin_test(void)
43 44 45 46 47 48
{
    QGeoCoordinate coord(_origin);
    coord.setAltitude(10.0); // offset altitude to test z

    double expectedX = 0.0;
    double expectedY = 0.0;
49
    double expectedZ = -10.0;
50 51

    double x, y, z;
52
    convertGeoToNed(coord, _origin, &x, &y, &z);
53 54 55 56 57 58

    QCOMPARE(x, expectedX);
    QCOMPARE(y, expectedY);
    QCOMPARE(z, expectedZ);
}

59
void GeoTest::_convertNedToGeo_test(void)
60 61 62 63 64 65 66 67 68 69
{
    double x = -1281.152128182419801305514;
    double y = 3486.949719522415307437768;
    double z = 0;

    double expectedLat = 47.364869;
    double expectedLon = 8.594398;
    double expectedAlt = 0.0;

    QGeoCoordinate coord;
70
    convertNedToGeo(x, y, z, _origin, &coord);
71 72 73 74 75 76

    QCOMPARE(coord.latitude(), expectedLat);
    QCOMPARE(coord.longitude(), expectedLon);
    QCOMPARE(coord.altitude(), expectedAlt);
}

77
void GeoTest::_convertNedToGeoAtOrigin_test(void)
78 79 80 81 82 83 84 85 86 87
{
    double x = 0.0;
    double y = 0.0;
    double z = 0.0;

    double expectedLat = _origin.latitude();
    double expectedLon = _origin.longitude();
    double expectedAlt = _origin.altitude();

    QGeoCoordinate coord;
88
    convertNedToGeo(x, y, z, _origin, &coord);
89 90 91 92 93

    QCOMPARE(coord.latitude(), expectedLat);
    QCOMPARE(coord.longitude(), expectedLon);
    QCOMPARE(coord.altitude(), expectedAlt);
}