Apply remarks from code review with additional cosmethics
This commit is contained in:
parent
f9fb7f947d
commit
d9ed45be56
@ -1,6 +1,7 @@
|
||||
#ifndef ASTAR_HPP
|
||||
#define ASTAR_HPP
|
||||
|
||||
#include <cmath> // std::isinf() is here
|
||||
#include <unordered_map>
|
||||
|
||||
#include "libslic3r/Point.hpp"
|
||||
@ -83,23 +84,23 @@ size_t unique_id(const T &tracer, const TracerNodeT<T> &n)
|
||||
|
||||
} // namespace astar_detail
|
||||
|
||||
constexpr size_t UNASSIGNED = size_t(-1);
|
||||
constexpr size_t Unassigned = size_t(-1);
|
||||
|
||||
template<class Tracer>
|
||||
struct QNode // Queue node. Keeps track of scores g, and h
|
||||
{
|
||||
TracerNodeT<Tracer> node; // The actual node itself
|
||||
size_t queue_id; // Position in the open queue or UNASSIGNED if closed
|
||||
size_t parent; // unique id of the parent or UNASSIGNED
|
||||
size_t queue_id; // Position in the open queue or Unassigned if closed
|
||||
size_t parent; // unique id of the parent or Unassigned
|
||||
|
||||
float g, h;
|
||||
float f() const { return g + h; }
|
||||
|
||||
QNode(TracerNodeT<Tracer> n = {},
|
||||
size_t p = UNASSIGNED,
|
||||
size_t p = Unassigned,
|
||||
float gval = std::numeric_limits<float>::infinity(),
|
||||
float hval = 0.f)
|
||||
: node{std::move(n)}, parent{p}, queue_id{UNASSIGNED}, g{gval}, h{hval}
|
||||
: node{std::move(n)}, parent{p}, queue_id{Unassigned}, g{gval}, h{hval}
|
||||
{}
|
||||
};
|
||||
|
||||
@ -143,15 +144,15 @@ bool search_route(const Tracer &tracer,
|
||||
},
|
||||
LessPred{cached_nodes});
|
||||
|
||||
QNode initial{source, /*parent = */ UNASSIGNED, /*g = */0.f};
|
||||
QNode initial{source, /*parent = */ Unassigned, /*g = */0.f};
|
||||
size_t source_id = unique_id(tracer, source);
|
||||
cached_nodes[source_id] = initial;
|
||||
qopen.push(source_id);
|
||||
|
||||
size_t goal_id = goal_heuristic(tracer, source) < 0.f ? source_id :
|
||||
UNASSIGNED;
|
||||
Unassigned;
|
||||
|
||||
while (goal_id == UNASSIGNED && !qopen.empty()) {
|
||||
while (goal_id == Unassigned && !qopen.empty()) {
|
||||
size_t q_id = qopen.top();
|
||||
qopen.pop();
|
||||
QNode &q = cached_nodes[q_id];
|
||||
@ -160,7 +161,7 @@ bool search_route(const Tracer &tracer,
|
||||
assert(!std::isinf(q.g));
|
||||
|
||||
foreach_reachable(tracer, q.node, [&](const Node &succ_nd) {
|
||||
if (goal_id != UNASSIGNED)
|
||||
if (goal_id != Unassigned)
|
||||
return true;
|
||||
|
||||
float h = goal_heuristic(tracer, succ_nd);
|
||||
@ -184,7 +185,7 @@ bool search_route(const Tracer &tracer,
|
||||
// The cache needs to be updated either way
|
||||
prev_nd = qsucc_nd;
|
||||
|
||||
if (queue_id == UNASSIGNED)
|
||||
if (queue_id == decltype(qopen)::invalid_id())
|
||||
// was in closed or unqueued, rescheduling
|
||||
qopen.push(succ_id);
|
||||
else // was in open, updating
|
||||
@ -192,24 +193,23 @@ bool search_route(const Tracer &tracer,
|
||||
}
|
||||
}
|
||||
|
||||
return goal_id != UNASSIGNED;
|
||||
return goal_id != Unassigned;
|
||||
});
|
||||
}
|
||||
|
||||
// Write the output, do not reverse. Clients can do so if they need to.
|
||||
if (goal_id != UNASSIGNED) {
|
||||
if (goal_id != Unassigned) {
|
||||
const QNode *q = &cached_nodes[goal_id];
|
||||
while (!std::isinf(q->g) && q->parent != UNASSIGNED) {
|
||||
while (q->parent != Unassigned) {
|
||||
assert(!std::isinf(q->g)); // Uninitialized nodes are NOT allowed
|
||||
|
||||
*out = q->node;
|
||||
++out;
|
||||
q = &cached_nodes[q->parent];
|
||||
}
|
||||
|
||||
if (std::isinf(q->g)) // Something went wrong
|
||||
goal_id = UNASSIGNED;
|
||||
}
|
||||
|
||||
return goal_id != UNASSIGNED;
|
||||
return goal_id != Unassigned;
|
||||
}
|
||||
|
||||
}} // namespace Slic3r::astar
|
||||
|
@ -384,11 +384,11 @@ TEST_CASE("Zero heuristic function should result in dijsktra's algo", "[AStar]")
|
||||
REQUIRE(out.empty());
|
||||
|
||||
// Source node should have it's parent unset
|
||||
REQUIRE(graph.nodes[0].parent == astar::UNASSIGNED);
|
||||
REQUIRE(graph.nodes[0].parent == astar::Unassigned);
|
||||
|
||||
// All other nodes should have their parents set
|
||||
for (size_t i = 1; i < graph.nodes.size(); ++i)
|
||||
REQUIRE(graph.nodes[i].parent != astar::UNASSIGNED);
|
||||
REQUIRE(graph.nodes[i].parent != astar::Unassigned);
|
||||
|
||||
std::array<float, 9> ref_distances = {0.f, 4.f, 12.f, 19.f, 21.f,
|
||||
11.f, 9.f, 8.f, 14.f};
|
||||
@ -398,9 +398,9 @@ TEST_CASE("Zero heuristic function should result in dijsktra's algo", "[AStar]")
|
||||
for (size_t i = 0, k = 0; i < graph.nodes.size(); ++i, k = 0) {
|
||||
GraphTracer::QNode *q = &graph.nodes[i];
|
||||
REQUIRE(q->g == Approx(ref_distances[i]));
|
||||
while (k++ < graph.nodes.size() && q->parent != astar::UNASSIGNED)
|
||||
while (k++ < graph.nodes.size() && q->parent != astar::Unassigned)
|
||||
q = &graph.nodes[q->parent];
|
||||
|
||||
REQUIRE(q->parent == astar::UNASSIGNED);
|
||||
REQUIRE(q->parent == astar::Unassigned);
|
||||
}
|
||||
}
|
||||
|
Loading…
Reference in New Issue
Block a user