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);
}