summaryrefslogtreecommitdiffhomepage
path: root/src/dijkstra.cpp
diff options
context:
space:
mode:
authorStanislaw Halik <sthalik@misaki.pl>2023-10-21 20:46:48 +0200
committerStanislaw Halik <sthalik@misaki.pl>2023-10-21 20:47:15 +0200
commit0e4539dfcb89e19f9d3917a86879c9eb658db7e4 (patch)
treeba541ec19db70d7e912929881aa97e2ac2815c9d /src/dijkstra.cpp
parentd34bfc5be1d9de17470e7306be6104889e633b40 (diff)
a
Diffstat (limited to 'src/dijkstra.cpp')
-rw-r--r--src/dijkstra.cpp13
1 files changed, 5 insertions, 8 deletions
diff --git a/src/dijkstra.cpp b/src/dijkstra.cpp
index b742c276..5b50a8f0 100644
--- a/src/dijkstra.cpp
+++ b/src/dijkstra.cpp
@@ -126,7 +126,7 @@ path_search_result astar::Dijkstra(world& w, const point from_, const point to_,
clear();
cache.allocate(from_, max_dist);
- constexpr auto min_size = Vector2ui{div_size*3/2};
+ constexpr auto min_size = Vector2ui{div_size};
const auto own_size = Math::max(Vector2ui(own_size_), min_size);
constexpr auto goal_thres = (uint32_t)(div_size.length() + 1.5f);
@@ -147,20 +147,17 @@ path_search_result astar::Dijkstra(world& w, const point from_, const point to_,
return {};
cache.allocate(from_, max_dist);
- nodes.push_back({.dist = 0, .pt = from_, });
- add_to_heap(0);
- { const auto bb0 = bbox_from_pos(Vector2(from.local()), {}, own_size);
+ { const auto bb0 = bbox_from_pos(Vector2(from.local()), from_offset, own_size);
constexpr int8_t div_min = -div_factor*2, div_max = div_factor*2;
for (int8_t y = div_min; y <= div_max; y++)
for (int8_t x = div_min; x <= div_max; x++)
{
- auto off_ = Vector2i(x, y) * div_size;
- auto off = Vector2(off_);
- auto bb1 = bbox<float>{ bb0.min + off, bb0.max + off};
+ auto off = Vector2i(x, y) * div_size;
+ auto pt = object::normalize_coords({from, {}}, off);
+ auto bb1 = bbox_from_pos(Vector2(pt.local()), pt.offset(), own_size);
auto bb = bbox_union(bb0, bb1);
- auto pt = object::normalize_coords({from, {}}, off_);
auto dist = distance(from_, pt);
if (path_search::is_passable(w, from.chunk3(), bb, own_id, p))