voxelcoreprojects/voxelcore
1
0
Fork 0
mirror of https://github.com/MihailRis/voxelcore.git synced 2026-10-07 12:01:50 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

add pathfinding library

Browse source
This commit is contained in:
MihailRis 2025-08-02 17:18:40 +03:00
parent 958fc1d689
commit caab689731
6 changed files with 126 additions and 2 deletions
Download patch file Download diff file Expand all files Collapse all files

24
src/voxels/Pathfinding.cpp
View file

@ -75,6 +75,12 @@ static void restore_route(
}
}
int Pathfinding::createAgent() {
int id = nextAgent++;
agents[id] = Agent();
return id;
}
Route Pathfinding::perform(
const Agent& agent, const glm::ivec3& start, const glm::ivec3& end
) {
@ -89,12 +95,16 @@ Route Pathfinding::perform(
std::unordered_map<glm::ivec3, Node> parents;
const auto& chunks = *level.chunks;
int height = std::max(agent.height, 1);
while (!queue.empty()) {
if (blocked.size() == agent.maxVisitedBlocks) {
break;
}
auto node = queue.top();
queue.pop();
if (node.pos.x == end.x && glm::abs((node.pos.y - end.y) / agent.height) == 0 && node.pos.z == end.z) {
if (node.pos.x == end.x && glm::abs((node.pos.y - end.y) / height) == 0 && node.pos.z == end.z) {
restore_route(route, node, parents);
route.nodes.push_back({start});
route.found = true;
@ -144,6 +154,18 @@ Route Pathfinding::perform(
return route;
}
Agent* Pathfinding::getAgent(int id) {
const auto& found = agents.find(id);
if (found != agents.end()) {
return &found->second;
}
return nullptr;
}
const std::unordered_map<int, Agent>& Pathfinding::getAgents() const {
return agents;
}
static int check_point(
const ContentUnitIndices<Block>& defs,
const GlobalChunks& chunks,