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
|
#include "goto.h"
#include <algorithm>
#include <game/activities/go.h>
#include <game/activity.h>
#include <game/network/link.h>
#include <game/network/routeWalker.h>
#include <game/objective.h>
#include <memory>
#include <numeric>
#include <vector>
GoTo::GoTo(Orders * o, const Link::End & cp, float d, const Node::Ptr & dest) :
Objective(o), links(RouteWalker().findRouteTo(cp, dest)), startDist {d}
{
}
ActivityPtr
GoTo::createActivity() const
{
return std::make_unique<Go>(std::accumulate(links.begin(), links.end(), 0.F,
[](auto p, const auto & l) {
return p += l.first.lock()->length;
})
+ startDist
);
}
inline bool
operator==(const Link::Next & l, const Link::Next & n)
{
return l.second == n.second && l.first.lock() == n.first.lock();
}
Link::Next
GoTo::navigate(Link::Nexts::const_iterator begin, Link::Nexts::const_iterator end) const
{
const auto nextStep = std::find_first_of(links.begin(), links.end(), begin, end);
if (nextStep == links.end()) {
return *begin;
}
return *nextStep;
}
|
