blob: 5b53aa03134fb55e1e3ef6902cc93793f9fa8e6d (
plain)
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
|
#pragma once
#include "geometry/point2d.hpp"
#include "base/math.hpp"
#include "std/limits.hpp"
namespace m2
{
namespace impl
{
template <typename PointT> class CalculatedSection
{
private:
static_assert(numeric_limits<typename PointT::value_type>::is_signed, "We do not support unsigned points!!!");
public:
void SetBounds(PointT const & p0, PointT const & p1)
{
m_P0 = p0;
m_P1 = p1;
m_D = m_P1 - m_P0;
m_D2 = Length(m_D);
if (my::AlmostEqualULPs(m_D2, 0.0))
{
// make zero vector - then all DotProduct will be equal to zero
m_D = m2::PointD::Zero();
}
else
{
// normalize vector
m_D = m_D / m_D2;
}
}
double GetLength() const { return m_D2; }
protected:
template <class VectorT> static double SquareLength(VectorT const & v)
{
return DotProduct(v, v);
}
template <class VectorT> static double Length(VectorT const & v)
{
return sqrt(SquareLength(v));
}
double Distance(PointD const & v) const
{
return CrossProduct(v, m_D);
}
PointT m_P0, m_P1;
m2::PointD m_D;
double m_D2;
};
}
template <typename PointT> class DistanceToLineSquare : public impl::CalculatedSection<PointT>
{
public:
double operator() (PointT const & Y) const
{
m2::PointD const YmP0 = Y - this->m_P0;
double const t = DotProduct(this->m_D, YmP0);
if (t <= 0)
{
// Y is closest to P0.
return this->SquareLength(YmP0);
}
if (t >= this->m_D2)
{
// Y is closest to P1.
return this->SquareLength(Y - this->m_P1);
}
// Closest point is interior to segment.
return my::sq(this->Distance(YmP0));
}
};
template <typename PointT> class ProjectionToSection : public impl::CalculatedSection<PointT>
{
public:
m2::PointD operator() (PointT const & Y) const
{
m2::PointD const YmP0 = Y - this->m_P0;
double const t = DotProduct(this->m_D, YmP0);
if (t <= 0)
{
// Y is closest to P0.
return this->m_P0;
}
if (t >= this->m_D2)
{
// Y is closest to P1.
return this->m_P1;
}
return this->m_D*t + this->m_P0;
}
};
}
|