blob: 217c6ae1e1ba12baabae7dbc6b973ba0d60e7e0e (
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
111
112
113
114
115
116
117
118
119
120
121
122
123
124
|
#include "spline.hpp"
namespace m2
{
void Spline::FromArray(vector<PointF> const & path)
{
if (path.empty())
return;
m_position.assign(path.begin(), path.end());
int cnt = m_position.size() - 1;
if (cnt == 0)
return;
m_direction = vector<PointF>(cnt);
m_length = vector<float>(cnt);
for(int i = 0; i < cnt; ++i)
{
m_direction[i] = path[i+1] - path[i];
m_length[i] = m_direction[i].Length();
m_direction[i] = m_direction[i].Normalize();
m_lengthAll += m_length[i];
}
}
void Spline::AddPoint(PointF const & pt)
{
if(m_position.empty())
m_position.push_back(pt);
else
{
PointF dir = pt - m_position.back();
m_position.push_back(pt);
m_direction.push_back(dir.Normalize());
m_length.push_back(dir.Length());
m_lengthAll += m_length.back();
}
}
Spline const & Spline::operator = (Spline const & spl)
{
if(&spl != this)
{
m_lengthAll = spl.m_lengthAll;
m_position = spl.m_position;
m_direction = spl.m_direction;
m_length = spl.m_length;
}
return *this;
}
Spline::iterator::iterator()
: m_checker(false)
, m_spl(NULL)
, m_index(0)
, m_dist(0) {}
void Spline::iterator::Attach(Spline const & S)
{
m_spl = &S;
m_index = 0;
m_dist = 0;
m_checker = false;
m_dir = m_spl->m_direction[m_index];
m_avrDir = m_spl->m_direction[m_index];
m_pos = m_spl->m_position[m_index] + m_dir * m_dist;
}
void Spline::iterator::Step(float speed)
{
m_dist += speed;
while(m_dist > m_spl->m_length[m_index])
{
m_dist -= m_spl->m_length[m_index];
m_index++;
if(m_index >= m_spl->m_direction.size())
{
m_index = 0;
m_checker = true;
}
}
m_dir = m_spl->m_direction[m_index];
m_avrDir = -m_pos;
m_pos = m_spl->m_position[m_index] + m_dir * m_dist;
m_avrDir += m_pos;
}
bool Spline::iterator::BeginAgain()
{
return m_checker;
}
SharedSpline::SharedSpline(vector<PointF> const & path)
{
m_spline.reset(new Spline(path));
}
SharedSpline::SharedSpline(SharedSpline const & other)
{
if (this != &other)
m_spline = other.m_spline;
}
SharedSpline const & SharedSpline::operator= (SharedSpline const & spl)
{
if (this != &spl)
m_spline = spl.m_spline;
return *this;
}
float SharedSpline::GetLength() const
{
return m_spline->GetLength();
}
Spline::iterator SharedSpline::CreateIterator()
{
Spline::iterator result;
result.Attach(*m_spline.get());
return result;
}
}
|