1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
#include "testing/testing.hpp"
#include "routing/base/followed_polyline.hpp"
#include "geometry/polyline2d.hpp"
namespace routing_test
{
using namespace routing;
namespace
{
static const m2::PolylineD kTestDirectedPolyline1({{0.0, 0.0}, {3.0, 0.0}, {5.0, 0.0}});
static const m2::PolylineD kTestDirectedPolyline2({{6.0, 0.0}, {7.0, 0.0}});
} // namespace
UNIT_TEST(FollowedPolylineAppend)
{
FollowedPolyline followedPolyline1(kTestDirectedPolyline1.Begin(), kTestDirectedPolyline1.End());
FollowedPolyline const followedPolyline2(kTestDirectedPolyline2.Begin(), kTestDirectedPolyline2.End());
TEST_EQUAL(followedPolyline1.GetPolyline(), kTestDirectedPolyline1, ());
followedPolyline1.Append(followedPolyline2);
TEST_EQUAL(followedPolyline1.GetPolyline().GetSize(), 5, ());
m2::PolylineD polyline1 = kTestDirectedPolyline1;
polyline1.Append(kTestDirectedPolyline2);
TEST_EQUAL(followedPolyline1.GetPolyline(), polyline1, ());
}
UNIT_TEST(FollowedPolylinePop)
{
FollowedPolyline followedPolyline(kTestDirectedPolyline1.Begin(), kTestDirectedPolyline1.End());
TEST_EQUAL(followedPolyline.GetPolyline(), kTestDirectedPolyline1, ());
TEST_EQUAL(followedPolyline.GetPolyline().GetSize(), 3, ());
followedPolyline.PopBack();
TEST_EQUAL(followedPolyline.GetPolyline().GetSize(), 2, ());
}
UNIT_TEST(FollowedPolylineInitializationFogTest)
{
FollowedPolyline polyline(kTestDirectedPolyline1.Begin(), kTestDirectedPolyline1.End());
TEST(polyline.IsValid(), ());
TEST_EQUAL(polyline.GetCurrentIter().m_ind, 0, ());
TEST_EQUAL(polyline.GetPolyline().GetSize(), 3, ());
}
UNIT_TEST(FollowedPolylineFollowingTestByProjection)
{
FollowedPolyline polyline(kTestDirectedPolyline1.Begin(), kTestDirectedPolyline1.End());
TEST_EQUAL(polyline.GetCurrentIter().m_ind, 0, ());
polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters({0, 0}, 2));
TEST_EQUAL(polyline.GetCurrentIter().m_ind, 0, ());
TEST_EQUAL(polyline.GetCurrentIter().m_pt, m2::PointD(0, 0), ());
polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters({1, 0}, 2));
TEST_EQUAL(polyline.GetCurrentIter().m_ind, 0, ());
TEST_EQUAL(polyline.GetCurrentIter().m_pt, m2::PointD(1, 0), ());
polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters({4, 0}, 2));
TEST_EQUAL(polyline.GetCurrentIter().m_ind, 1, ());
TEST_EQUAL(polyline.GetCurrentIter().m_pt, m2::PointD(4, 0), ());
auto iter = polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters({5.0001, 0}, 1));
TEST(!iter.IsValid(), ());
TEST_EQUAL(polyline.GetCurrentIter().m_ind, 1, ());
TEST_EQUAL(polyline.GetCurrentIter().m_pt, m2::PointD(4, 0), ());
polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters({5.0001, 0}, 2000));
TEST_EQUAL(polyline.GetCurrentIter().m_ind, 1, ());
TEST_EQUAL(polyline.GetCurrentIter().m_pt, m2::PointD(5, 0), ());
}
UNIT_TEST(FollowedPolylineDistanceCalculationTest)
{
// Test full length case.
FollowedPolyline polyline(kTestDirectedPolyline1.Begin(), kTestDirectedPolyline1.End());
double distance = polyline.GetDistanceM(polyline.Begin(), polyline.End());
double masterDistance = mercator::DistanceOnEarth(kTestDirectedPolyline1.Front(),
kTestDirectedPolyline1.Back());
TEST_ALMOST_EQUAL_ULPS(distance, masterDistance, ());
distance = polyline.GetTotalDistanceMeters();
TEST_ALMOST_EQUAL_ULPS(distance, masterDistance, ());
// Test partial length case.
polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters({3, 0}, 2));
distance = polyline.GetDistanceM(polyline.GetCurrentIter(), polyline.End());
masterDistance = mercator::DistanceOnEarth(kTestDirectedPolyline1.GetPoint(1),
kTestDirectedPolyline1.Back());
TEST_ALMOST_EQUAL_ULPS(distance, masterDistance, ());
distance = polyline.GetDistanceToEndMeters();
TEST_ALMOST_EQUAL_ULPS(distance, masterDistance, ());
// Test point in the middle case.
polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters({4, 0}, 2));
distance = polyline.GetDistanceM(polyline.GetCurrentIter(), polyline.End());
masterDistance = mercator::DistanceOnEarth(m2::PointD(4, 0),
kTestDirectedPolyline1.Back());
TEST_ALMOST_EQUAL_ULPS(distance, masterDistance, ());
distance = polyline.GetDistanceToEndMeters();
TEST_ALMOST_EQUAL_ULPS(distance, masterDistance, ());
}
UNIT_TEST(FollowedPolylineDirectionTest)
{
m2::PolylineD testPolyline({{0, 0}, {1.00003, 0}, {1.00003, 1}});
FollowedPolyline polyline(testPolyline.Begin(), testPolyline.End());
TEST_EQUAL(polyline.GetCurrentIter().m_ind, 0, ());
m2::PointD directionPoint;
polyline.GetCurrentDirectionPoint(directionPoint, 20);
TEST_EQUAL(directionPoint, testPolyline.GetPoint(1), ());
polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters({1.0, 0}, 2));
polyline.GetCurrentDirectionPoint(directionPoint, 0.0001);
TEST_EQUAL(directionPoint, testPolyline.GetPoint(1), ());
polyline.GetCurrentDirectionPoint(directionPoint, 20);
TEST_EQUAL(directionPoint, testPolyline.GetPoint(2), ());
}
UNIT_TEST(FollowedPolylineGetDistanceFromBeginM)
{
m2::PolylineD testPolyline({{0, 0}, {1, 0}, {2, 0}, {3, 0}, {5, 0}, {6, 0}});
FollowedPolyline polyline(testPolyline.Begin(), testPolyline.End());
m2::PointD point(4, 0);
polyline.UpdateProjection(mercator::RectByCenterXYAndSizeInMeters(point, 2));
double const distance = polyline.GetDistanceFromStartMeters();
double const masterDistance =
mercator::DistanceOnEarth(kTestDirectedPolyline1.Front(), point);
TEST_ALMOST_EQUAL_ULPS(distance, masterDistance, ());
}
} // namespace routing_test
|
