test/geo/Test_geo_geodesic.cpp

   1 #include <marnav/geo/geodesic.hpp>
   2 #include <marnav/math/constants.hpp>
   3 #include <gtest/gtest.h>
   4
   5 namespace
   6 {
   7 using namespace marnav;
   8 using marnav::math::pi;
   9
  10 class Test_geo_geodesic : public ::testing::Test
  11 {
  12 };
  13
  14 TEST_F(Test_geo_geodesic, central_spherical_angle_default_constructed)
  15 {
  16         geo::position p0;
  17         geo::position p1;
  18
  19         auto d = geo::central_spherical_angle(p0, p1);
  20
  21         EXPECT_NEAR(d, 0.0, 1e-6);
  22 }
  23
  24 TEST_F(Test_geo_geodesic, central_spherical_angle)
  25 {
  26         struct test_data {
  27                 geo::position p0;
  28                 geo::position p1;
  29                 double angle_rad;
  30         };
  31
  32         static const test_data DATA[] = {
  33                 {{0.0, 0.0}, {0.0, 0.0}, 0.0 * pi / 180.0},
  34                 {{45.0, 0.0}, {0.0, 0.0}, 45.0 * pi / 180.0},
  35                 {{0.0, 45.0}, {0.0, 0.0}, 45.0 * pi / 180.0},
  36                 {{0.0, 0.0}, {45.0, 0.0}, 45.0 * pi / 180.0},
  37                 {{0.0, 0.0}, {0.0, 45.0}, 45.0 * pi / 180.0},
  38         };
  39
  40         for (auto const & item : DATA) {
  41                 auto d = geo::central_spherical_angle(item.p0, item.p1);
  42                 EXPECT_NEAR(d, item.angle_rad, 1e-6);
  43         }
  44 }
  45
  46 TEST_F(Test_geo_geodesic, distance_sphere)
  47 {
  48         const geo::position BNA = {36.12, -86.67};
  49         const geo::position LAX = {33.94, -118.40};
  50
  51         const double expected = 2889615.861940;
  52         // exact would be     : 2892777.232346 m
  53
  54         auto result = geo::distance_sphere(BNA, LAX);
  55
  56         EXPECT_NEAR(expected, result.distance, 1e-3);
  57 }
  58
  59 TEST_F(Test_geo_geodesic, distance_ellipsoid_vincenty_BNA_LAX)
  60 {
  61         const geo::position BNA = {36.12, -86.67};
  62         const geo::position LAX = {33.94, -118.40};
  63
  64         const double expected = 2892777.2323462227;
  65         // exact would be     : 2892777.232346 m
  66
  67         auto result = geo::distance_ellipsoid_vincenty(BNA, LAX);
  68
  69         EXPECT_NEAR(expected, result.distance, 1e-3);
  70 }
  71
  72 TEST_F(Test_geo_geodesic, distance_ellipsoid_vincenty_same_longitude)
  73 {
  74         const geo::position p1 = {00.0, 0.0};
  75         const geo::position p2 = {30.0, 0.0};
  76
  77         // test value computed using: http://www.ga.gov.au/geodesy/datums/vincenty_inverse.jsp
  78         const double expected = 3320113.398; // [m]
  79
  80         auto result = geo::distance_ellipsoid_vincenty(p1, p2);
  81
  82         EXPECT_NEAR(expected, result.distance, 0.1);
  83 }
  84
  85 TEST_F(Test_geo_geodesic, distance_ellipsoid_vincenty_same_latitude)
  86 {
  87         const geo::position p1 = {0.0, 0.0};
  88         const geo::position p2 = {0.0, 30.0};
  89
  90         // test value computed using: http://www.ga.gov.au/geodesy/datums/vincenty_inverse.jsp
  91         const double expected = 3339584.724; // [m]
  92
  93         auto result = geo::distance_ellipsoid_vincenty(p1, p2);
  94
  95         EXPECT_NEAR(expected, result.distance, 0.1);
  96 }
  97
  98 TEST_F(Test_geo_geodesic, distance_ellipsoid_lambert)
  99 {
 100         const geo::position BNA = {36.12, -86.67};
 101         const geo::position LAX = {33.94, -118.40};
 102
 103         const double expected = 3013798.3235893762;
 104         // exact would be     : 2892777.232346 m
 105
 106         auto result = geo::distance_ellipsoid_lambert(BNA, LAX);
 107
 108         EXPECT_NEAR(expected, result.distance, 1e-3);
 109 }
 110
 111 TEST_F(Test_geo_geodesic, point_ellipsoid_vincenty)
 112 {
 113         struct test_data {
 114                 geo::position start;
 115                 double azimuth;
 116                 double distance;
 117                 geo::position expected;
 118         };
 119
 120         static const test_data DATA[] = {
 121                 {{0.0, 0.0}, 0.0 * pi / 180.0, 60 * 1852.0, {1.0049343, 0.0}},
 122                 {{0.0, 0.0}, 90.0 * pi / 180.0, 60 * 1852.0, {0.0, 0.99820794}},
 123         };
 124
 125         for (auto const & item : DATA) {
 126                 double alpha2 = 0.0;
 127                 auto destination
 128                         = geo::point_ellipsoid_vincenty(item.start, item.distance, item.azimuth, alpha2);
 129                 EXPECT_NEAR(item.expected.lat(), destination.lat(), 1e-4);
 130                 EXPECT_NEAR(item.expected.lon(), destination.lon(), 1e-4);
 131         }
 132 }
 133 }