ceph/src/boost/libs/geometry/test/formulas/intersection.cpp

   1 // Boost.Geometry
   2 // Unit Test
   3
   4 // Copyright (c) 2016 Oracle and/or its affiliates.
   5
   6 // Contributed and/or modified by Adam Wulkiewicz, on behalf of Oracle
   7
   8 // Use, modification and distribution is subject to the Boost Software License,
   9 // Version 1.0. (See accompanying file LICENSE_1_0.txt or copy at
  10 // http://www.boost.org/LICENSE_1_0.txt)
  11
  12 #include "test_formula.hpp"
  13 #include "intersection_cases.hpp"
  14
  15 #include <boost/geometry/formulas/andoyer_inverse.hpp>
  16 #include <boost/geometry/formulas/geographic.hpp>
  17 #include <boost/geometry/formulas/gnomonic_intersection.hpp>
  18 #include <boost/geometry/formulas/sjoberg_intersection.hpp>
  19 #include <boost/geometry/formulas/thomas_direct.hpp>
  20 #include <boost/geometry/formulas/thomas_inverse.hpp>
  21 #include <boost/geometry/formulas/vincenty_direct.hpp>
  22 #include <boost/geometry/formulas/vincenty_inverse.hpp>
  23
  24 void check_result(expected_result const& result, expected_result const& expected,
  25                   expected_result const& reference, double reference_error,
  26                   bool check_reference_only)
  27 {
  28     //BOOST_CHECK_MESSAGE((false), "(" << result.lon << " " << result.lat << ") vs (" << expected.lon << " " << expected.lat << ")");
  29     check_one(result.lon, expected.lon, reference.lon, reference_error, false, check_reference_only);
  30     check_one(result.lat, expected.lat, reference.lat, reference_error, false, check_reference_only);
  31 }
  32
  33 void test_formulas(expected_results const& results, bool check_reference_only)
  34 {
  35     // reference result
  36     if (results.sjoberg_vincenty.lon == ND)
  37     {
  38         return;
  39     }
  40
  41     double const d2r = bg::math::d2r<double>();
  42     double const r2d = bg::math::r2d<double>();
  43
  44     double lona1r = results.p1.lon * d2r;
  45     double lata1r = results.p1.lat * d2r;
  46     double lona2r = results.p2.lon * d2r;
  47     double lata2r = results.p2.lat * d2r;
  48     double lonb1r = results.q1.lon * d2r;
  49     double latb1r = results.q1.lat * d2r;
  50     double lonb2r = results.q2.lon * d2r;
  51     double latb2r = results.q2.lat * d2r;
  52
  53     expected_result result;
  54
  55     // WGS84
  56     bg::srs::spheroid<double> spheroid(6378137.0, 6356752.3142451793);
  57
  58     if (results.gnomonic_vincenty.lon != ND)
  59     {
  60         bg::formula::gnomonic_intersection<double, bg::formula::vincenty_inverse, bg::formula::vincenty_direct>
  61             ::apply(lona1r, lata1r, lona2r, lata2r, lonb1r, latb1r, lonb2r, latb2r, result.lon, result.lat, spheroid);
  62         result.lon *= r2d;
  63         result.lat *= r2d;
  64         check_result(result, results.gnomonic_vincenty, results.sjoberg_vincenty, 0.00000001, check_reference_only);
  65     }
  66
  67     if (results.gnomonic_thomas.lon != ND)
  68     {
  69         bg::formula::gnomonic_intersection<double, bg::formula::thomas_inverse, bg::formula::thomas_direct>
  70             ::apply(lona1r, lata1r, lona2r, lata2r, lonb1r, latb1r, lonb2r, latb2r, result.lon, result.lat, spheroid);
  71         result.lon *= r2d;
  72         result.lat *= r2d;
  73         check_result(result, results.gnomonic_thomas, results.sjoberg_vincenty, 0.0000001, check_reference_only);
  74     }
  75
  76     if (results.sjoberg_vincenty.lon != ND)
  77     {
  78         bg::formula::sjoberg_intersection<double, bg::formula::vincenty_inverse, 4>
  79             ::apply(lona1r, lata1r, lona2r, lata2r, lonb1r, latb1r, lonb2r, latb2r, result.lon, result.lat, spheroid);
  80         result.lon *= r2d;
  81         result.lat *= r2d;
  82         check_result(result, results.sjoberg_vincenty, results.sjoberg_vincenty, 0.00000001, check_reference_only);
  83     }
  84
  85     if (results.sjoberg_thomas.lon != ND)
  86     {
  87         bg::formula::sjoberg_intersection<double, bg::formula::thomas_inverse, 2>
  88             ::apply(lona1r, lata1r, lona2r, lata2r, lonb1r, latb1r, lonb2r, latb2r, result.lon, result.lat, spheroid);
  89         result.lon *= r2d;
  90         result.lat *= r2d;
  91         check_result(result, results.sjoberg_thomas, results.sjoberg_vincenty, 0.0000001, check_reference_only);
  92     }
  93
  94     if (results.sjoberg_andoyer.lon != ND)
  95     {
  96         bg::formula::sjoberg_intersection<double, bg::formula::andoyer_inverse, 1>
  97             ::apply(lona1r, lata1r, lona2r, lata2r, lonb1r, latb1r, lonb2r, latb2r, result.lon, result.lat, spheroid);
  98         result.lon *= r2d;
  99         result.lat *= r2d;
 100         check_result(result, results.sjoberg_andoyer, results.sjoberg_vincenty, 0.0001, check_reference_only);
 101     }
 102
 103     if (results.great_elliptic.lon != ND)
 104     {
 105         typedef bg::model::point<double, 2, bg::cs::geographic<bg::degree> > point_geo;
 106         typedef bg::model::point<double, 3, bg::cs::cartesian> point_3d;
 107         point_geo a1(results.p1.lon, results.p1.lat);
 108         point_geo a2(results.p2.lon, results.p2.lat);
 109         point_geo b1(results.q1.lon, results.q1.lat);
 110         point_geo b2(results.q2.lon, results.q2.lat);
 111         point_3d a1v = bg::formula::geo_to_cart3d<point_3d>(a1, spheroid);
 112         point_3d a2v = bg::formula::geo_to_cart3d<point_3d>(a2, spheroid);
 113         point_3d b1v = bg::formula::geo_to_cart3d<point_3d>(b1, spheroid);
 114         point_3d b2v = bg::formula::geo_to_cart3d<point_3d>(b2, spheroid);
 115         point_3d resv(0, 0, 0);
 116         point_geo res(0, 0);
 117         bg::formula::great_elliptic_intersection(a1v, a2v, b1v, b2v, resv, spheroid);
 118         res = bg::formula::cart3d_to_geo<point_geo>(resv, spheroid);
 119         result.lon = bg::get<0>(res);
 120         result.lat = bg::get<1>(res);
 121         check_result(result, results.great_elliptic, results.sjoberg_vincenty, 0.01, check_reference_only);
 122     }
 123 }
 124
 125 void test_4_input_combinations(expected_results const& results, bool check_reference_only)
 126 {
 127     test_formulas(results, check_reference_only);
 128
 129 #ifdef BOOST_GEOMETRY_TEST_GEO_INTERSECTION_TEST_SIMILAR
 130     {
 131         expected_results results_alt = results;
 132         std::swap(results_alt.p1, results_alt.p2);
 133         test_formulas(results_alt, true);
 134     }
 135     {
 136         expected_results results_alt = results;
 137         std::swap(results_alt.q1, results_alt.q2);
 138         test_formulas(results_alt, true);
 139     }
 140     {
 141         expected_results results_alt = results;
 142         std::swap(results_alt.p1, results_alt.p2);
 143         std::swap(results_alt.q1, results_alt.q2);
 144         test_formulas(results_alt, true);
 145     }
 146 #endif
 147 }
 148
 149 void test_all(expected_results const& results)
 150 {
 151     test_4_input_combinations(results, false);
 152
 153 #ifdef BOOST_GEOMETRY_TEST_GEO_INTERSECTION_TEST_SIMILAR
 154     expected_results results_alt = results;
 155     results_alt.p1.lat *= -1;
 156     results_alt.p2.lat *= -1;
 157     results_alt.q1.lat *= -1;
 158     results_alt.q2.lat *= -1;
 159     results_alt.gnomonic_vincenty.lat *= -1;
 160     results_alt.gnomonic_thomas.lat *= -1;
 161     results_alt.sjoberg_vincenty.lat *= -1;
 162     results_alt.sjoberg_thomas.lat *= -1;
 163     results_alt.sjoberg_andoyer.lat *= -1;
 164     results_alt.great_elliptic.lat *= -1;
 165     test_4_input_combinations(results_alt, true);
 166 #endif
 167 }
 168
 169 int test_main(int, char*[])
 170 {
 171     for (size_t i = 0; i < expected_size; ++i)
 172     {
 173         test_all(expected[i]);
 174     }
 175
 176     return 0;
 177 }