1 #include "util/bearing.hpp"
2 #include "util/typedefs.hpp"
3
4 #include <boost/functional/hash.hpp>
5 #include <boost/test/unit_test.hpp>
6
7 BOOST_AUTO_TEST_SUITE(bearing_test)
8
9 using namespace osrm;
10 using namespace osrm::util;
11
12 // Verify that the bearing-bounds checking function behaves as expected
BOOST_AUTO_TEST_CASE(bearing_range_test)13 BOOST_AUTO_TEST_CASE(bearing_range_test)
14 {
15 // Simple, non-edge-case checks
16 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(45, 45, 10));
17 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(35, 45, 10));
18 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(55, 45, 10));
19
20 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(34, 45, 10));
21 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(56, 45, 10));
22
23 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(34, 45, 10));
24 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(56, 45, 10));
25
26 // When angle+limit goes > 360
27 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(359, 355, 10));
28
29 // When angle-limit goes < 0
30 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(359, 5, 10));
31 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(354, 5, 10));
32 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(16, 5, 10));
33
34 // Checking other cases of wraparound
35 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(359, -5, 10));
36 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(344, -5, 10));
37 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(6, -5, 10));
38
39 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(-1, 5, 10));
40 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(-6, 5, 10));
41
42 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(-721, 5, 10));
43 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(719, 5, 10));
44
45 BOOST_CHECK_EQUAL(false, bearing::CheckInBounds(1, 1, -1));
46 BOOST_CHECK_EQUAL(true, bearing::CheckInBounds(1, 1, 0));
47 }
48
BOOST_AUTO_TEST_CASE(bearing_angle_test)49 BOOST_AUTO_TEST_CASE(bearing_angle_test)
50 {
51 BOOST_CHECK_EQUAL(bearing::angleBetween(257.78421507794314, 77.784215077943117), 0.);
52 BOOST_CHECK_EQUAL(bearing::angleBetween(77.784215077943117, 257.78421507794314), 0.);
53
54 // Check quadrants
55 BOOST_CHECK_EQUAL(bearing::angleBetween(45., 45.), 180.);
56 BOOST_CHECK_EQUAL(bearing::angleBetween(45., 315.), 270.);
57 BOOST_CHECK_EQUAL(bearing::angleBetween(45., 225.), 0.);
58 BOOST_CHECK_EQUAL(bearing::angleBetween(45., 135.), 90.);
59 BOOST_CHECK_EQUAL(bearing::angleBetween(45., 90.), 135.);
60
61 // Check edge cases
62 BOOST_CHECK_EQUAL(bearing::angleBetween(0., 360.), 180.);
63 BOOST_CHECK_EQUAL(bearing::angleBetween(360., 0.), 180.);
64 BOOST_CHECK_EQUAL(bearing::angleBetween(0., 0.), 180.);
65 BOOST_CHECK_EQUAL(bearing::angleBetween(360., 360.), 180.);
66
67 BOOST_CHECK_EQUAL(bearing::angleBetween(0., 180.), 0.);
68 BOOST_CHECK_EQUAL(bearing::angleBetween(360., 180.), 0.);
69 BOOST_CHECK_EQUAL(bearing::angleBetween(180., 0.), 0.);
70 BOOST_CHECK_EQUAL(bearing::angleBetween(180., 360.), 0.);
71
72 BOOST_CHECK_EQUAL(bearing::angleBetween(90., 270.01), 359.99);
73
74 // 5 digits loss due to cancellation in 90+180-269.99
75 BOOST_CHECK_CLOSE(bearing::angleBetween(90., 269.99), 0.01, 1e-10);
76 }
77
78 BOOST_AUTO_TEST_SUITE_END()
79