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
|
#include "routing/fake_ending.hpp"
#include "routing/edge_estimator.hpp"
#include "routing/index_graph.hpp"
#include "routing/world_graph.hpp"
#include "geometry/distance.hpp"
#include "base/math.hpp"
#include <utility>
using namespace routing;
using namespace std;
namespace
{
template <typename Estimator>
Junction CalcProjectionToSegment(Junction const & begin, Junction const & end,
m2::PointD const & point, Estimator && estimator)
{
m2::ProjectionToSection<m2::PointD> projection;
projection.SetBounds(begin.GetPoint(), end.GetPoint());
auto const projectedPoint = projection(point);
auto const distBeginToEnd = estimator(begin.GetPoint(), end.GetPoint());
double constexpr kEpsMeters = 2.0;
if (my::AlmostEqualAbs(distBeginToEnd, 0.0, kEpsMeters))
return Junction(projectedPoint, begin.GetAltitude());
auto const distBeginToProjection = estimator(begin.GetPoint(), projectedPoint);
auto const altitude = begin.GetAltitude() + (end.GetAltitude() - begin.GetAltitude()) *
distBeginToProjection / distBeginToEnd;
return Junction(projectedPoint, altitude);
}
template <typename Estimator>
FakeEnding MakeFakeEndingImpl(Junction const & backJunction, Junction const & frontJunction,
Segment const & segment, m2::PointD const & point, bool oneWay,
Estimator && estimator)
{
auto const & projectedJunction =
CalcProjectionToSegment(backJunction, frontJunction, point, forward<Estimator>(estimator));
FakeEnding ending;
ending.m_originJunction = Junction(point, projectedJunction.GetAltitude());
ending.m_projections.emplace_back(segment, oneWay, frontJunction, backJunction,
projectedJunction);
return ending;
}
} // namespace
namespace routing
{
FakeEnding MakeFakeEnding(Segment const & segment, m2::PointD const & point,
EdgeEstimator const & estimator, IndexGraph & graph)
{
auto const & road = graph.GetGeometry().GetRoad(segment.GetFeatureId());
bool const oneWay = road.IsOneWay();
auto const & frontJunction = road.GetJunction(segment.GetPointId(true /* front */));
auto const & backJunction = road.GetJunction(segment.GetPointId(false /* front */));
return MakeFakeEndingImpl(backJunction, frontJunction, segment, point, oneWay,
[&](m2::PointD const & p1, m2::PointD const & p2) {
return estimator.CalcLeapWeight(p1, p2);
});
}
FakeEnding MakeFakeEnding(Segment const & segment, m2::PointD const & point, WorldGraph & graph)
{
bool const oneWay = graph.IsOneWay(segment.GetMwmId(), segment.GetFeatureId());
auto const & frontJunction = graph.GetJunction(segment, true /* front */);
auto const & backJunction = graph.GetJunction(segment, false /* front */);
return MakeFakeEndingImpl(backJunction, frontJunction, segment, point, oneWay,
[&](m2::PointD const & p1, m2::PointD const & p2) {
return graph.CalcLeapWeight(p1, p2).GetWeight();
});
}
} // namespace routing
|
