feat: Replace FastAStarAlgorithm with BitmapAStarAlgorithm (#2446)
## Summary Replaces `FastAStarAlgorithm` with `BitmapAStarAlgorithm`: one cache lookup per cell expansion (8-direction mask + per-direction destination Z) instead of 8 separate `MovementImpl.CheckMovement` calls. Adds the supporting cache infrastructure to back it. Public API unchanged — `MovementPath` / `Mobile.Move` / `CalcMoves.Find` return the same shapes; the algorithm swap is internal. ## What's in this PR - **`BitmapAStarAlgorithm`** — A* that issues one `StepCache.TryGetMask` call per cell expansion. Inline fallthrough to the per-cell slow path for multi-Z, off-map, source-Z mismatch, and non-default walkers. - **`StepCache`** — singleton chunk store keyed by `(mapId, chunkX, chunkY)`. Lazily built on first query, invalidated by `Sector.MultisVersion` mismatch, memory-bounded by sampled probabilistic LRU. - **`StepProbe`** — computes static-only walkability for a single cell, mirroring `MovementImpl.Check` minus the item / mobile collision phases. - **`StepMask` / `StepChunk`** — value / storage types for the per-cell results. - **`CacheEvictionTimer`** — periodic cap backstop (60s interval; early-returns when not over cap). - **`Map.Sector.MultisVersion`** promoted to `public` so the cache can detect dynamic-static invalidations cheaply. ## Eviction strategy Sampled probabilistic LRU (Redis-style). Per eviction, sample 5 random keys from a parallel `List<long>` kept in lockstep with the chunk dictionary; evict the oldest of the sample via swap-and-pop. O(1) per eviction regardless of resident count, so sustained cap pressure has no perpetual perf hit. ## Capability handling (interim) Non-default walkers (non-GM players, creatures with `CanSwim` / `CanFly` / `CanOpenDoors` / `CanMoveOverObstacles`) route entirely through the per-cell slow path via `BitmapAStarAlgorithm.GetSuccessorsSlowPath`. The 2-pass design (cache + capability overlay + dynamic-obstacle pass) lands in the follow-up PR.
This commit is contained in:
parent
ee1bf23b72
commit
6a3804addc
16 changed files with 1832 additions and 50 deletions
|
|
@ -1,297 +0,0 @@
|
|||
/*************************************************************************
|
||||
* ModernUO *
|
||||
* Copyright 2019-2026 - ModernUO Development Team *
|
||||
* Email: hi@modernuo.com *
|
||||
* File: FastAStarAlgorithm.cs *
|
||||
* *
|
||||
* This program is free software: you can redistribute it and/or modify *
|
||||
* it under the terms of the GNU General Public License as published by *
|
||||
* the Free Software Foundation, either version 3 of the License, or *
|
||||
* (at your option) any later version. *
|
||||
* *
|
||||
* You should have received a copy of the GNU General Public License *
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>. *
|
||||
************************************************************************/
|
||||
|
||||
using System;
|
||||
using Server.Mobiles;
|
||||
using CalcMoves = Server.Movement.Movement;
|
||||
using MoveImpl = Server.Movement.MovementImpl;
|
||||
using System.Collections.Generic;
|
||||
using System.Runtime.CompilerServices;
|
||||
|
||||
namespace Server.PathAlgorithms.FastAStar;
|
||||
|
||||
public class FastAStarAlgorithm : PathAlgorithm
|
||||
{
|
||||
private struct PathNode
|
||||
{
|
||||
public int cost;
|
||||
public int total;
|
||||
public int parent;
|
||||
public int z;
|
||||
}
|
||||
|
||||
private const int MaxDepth = 300;
|
||||
private const int AreaSize = 38;
|
||||
|
||||
private const int NodeCount = AreaSize * AreaSize * PlaneCount;
|
||||
|
||||
private const int PlaneOffset = 128;
|
||||
private const int PlaneCount = 13;
|
||||
private const int PlaneHeight = 20;
|
||||
public static readonly PathAlgorithm Instance = new FastAStarAlgorithm();
|
||||
|
||||
private static readonly Direction[] _path = new Direction[AreaSize * AreaSize];
|
||||
private static readonly PathNode[] _nodes = new PathNode[NodeCount];
|
||||
private static readonly byte[] _nodeStates = new byte[NodeCount];
|
||||
private static readonly int[] _successors = new int[8];
|
||||
private static readonly PriorityQueue<int, int> _openQueue = new();
|
||||
|
||||
private static int _xOffset;
|
||||
private static int _yOffset;
|
||||
|
||||
private Point3D _goal;
|
||||
|
||||
[MethodImpl(MethodImplOptions.AggressiveInlining)]
|
||||
public int Heuristic(int x, int y, int z)
|
||||
{
|
||||
x -= _goal.X - _xOffset;
|
||||
y -= _goal.Y - _yOffset;
|
||||
z -= _goal.Z;
|
||||
|
||||
x *= 11;
|
||||
y *= 11;
|
||||
|
||||
return x * x + y * y + z * z;
|
||||
}
|
||||
|
||||
public override bool CheckCondition(Mobile m, Map map, Point3D start, Point3D goal) =>
|
||||
Utility.InRange(start, goal, AreaSize);
|
||||
|
||||
public override Direction[] Find(Mobile m, Map map, Point3D start, Point3D goal)
|
||||
{
|
||||
if (!Utility.InRange(start, goal, AreaSize))
|
||||
{
|
||||
return null;
|
||||
}
|
||||
|
||||
Array.Clear(_nodeStates);
|
||||
|
||||
_goal = goal;
|
||||
|
||||
_xOffset = (start.X + goal.X - AreaSize) / 2;
|
||||
_yOffset = (start.Y + goal.Y - AreaSize) / 2;
|
||||
|
||||
var fromNode = GetIndex(start.X, start.Y, start.Z);
|
||||
var destNode = GetIndex(goal.X, goal.Y, goal.Z);
|
||||
|
||||
_nodes[fromNode].cost = 0;
|
||||
_nodes[fromNode].total = Heuristic(start.X - _xOffset, start.Y - _yOffset, start.Z);
|
||||
_nodes[fromNode].parent = -1;
|
||||
_nodes[fromNode].z = start.Z;
|
||||
|
||||
_openQueue.Enqueue(fromNode, _nodes[fromNode].total);
|
||||
_nodeStates[fromNode] = 1;
|
||||
|
||||
var bc = m as BaseCreature;
|
||||
|
||||
int backtrack = 0, depth = 0;
|
||||
|
||||
var path = _path;
|
||||
|
||||
while (_openQueue.Count > 0)
|
||||
{
|
||||
if (++depth > MaxDepth)
|
||||
{
|
||||
break;
|
||||
}
|
||||
|
||||
if (!_openQueue.TryDequeue(out var bestNode, out var bestTotal))
|
||||
{
|
||||
break;
|
||||
}
|
||||
|
||||
// Duplicate, lower priority
|
||||
if (_nodeStates[bestNode] == 2 || _nodes[bestNode].total != bestTotal)
|
||||
{
|
||||
continue;
|
||||
}
|
||||
|
||||
_nodeStates[bestNode] = 2;
|
||||
|
||||
if (bc != null)
|
||||
{
|
||||
MoveImpl.AlwaysIgnoreDoors = bc.CanOpenDoors;
|
||||
MoveImpl.IgnoreMovableImpassables = bc.CanMoveOverObstacles;
|
||||
}
|
||||
|
||||
MoveImpl.Goal = goal;
|
||||
|
||||
var vals = _successors;
|
||||
var count = GetSuccessors(bestNode, m, map);
|
||||
|
||||
MoveImpl.AlwaysIgnoreDoors = false;
|
||||
MoveImpl.IgnoreMovableImpassables = false;
|
||||
MoveImpl.Goal = Point3D.Zero;
|
||||
|
||||
if (count == 0)
|
||||
{
|
||||
continue;
|
||||
}
|
||||
|
||||
for (var i = 0; i < count; ++i)
|
||||
{
|
||||
var newNode = vals[i];
|
||||
|
||||
// Skip if the node is already closed
|
||||
if (_nodeStates[newNode] == 2)
|
||||
{
|
||||
continue;
|
||||
}
|
||||
|
||||
var isDiagonal = i % 2 == 1;
|
||||
var moveCost = isDiagonal ? 14 : 10;
|
||||
var newCost = _nodes[bestNode].cost + moveCost;
|
||||
var newTotal = newCost + Heuristic(
|
||||
newNode % AreaSize,
|
||||
newNode / AreaSize % AreaSize,
|
||||
_nodes[newNode].z
|
||||
);
|
||||
|
||||
if (_nodeStates[newNode] == 0 || newTotal < _nodes[newNode].total)
|
||||
{
|
||||
_nodes[newNode].parent = bestNode;
|
||||
_nodes[newNode].cost = newCost;
|
||||
_nodes[newNode].total = newTotal;
|
||||
|
||||
// Requeue (duplicates allowed), and mark as open
|
||||
_openQueue.Enqueue(newNode, newTotal);
|
||||
_nodeStates[newNode] = 1;
|
||||
}
|
||||
|
||||
if (newNode != destNode)
|
||||
{
|
||||
continue;
|
||||
}
|
||||
|
||||
var pathCount = 0;
|
||||
var parent = _nodes[newNode].parent;
|
||||
|
||||
while (parent != -1)
|
||||
{
|
||||
path[pathCount++] = GetDirection(
|
||||
parent % AreaSize,
|
||||
parent / AreaSize % AreaSize,
|
||||
newNode % AreaSize,
|
||||
newNode / AreaSize % AreaSize
|
||||
);
|
||||
newNode = parent;
|
||||
parent = _nodes[newNode].parent;
|
||||
|
||||
if (newNode == fromNode)
|
||||
{
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
var dirs = new Direction[pathCount];
|
||||
|
||||
while (pathCount > 0)
|
||||
{
|
||||
dirs[backtrack++] = path[--pathCount];
|
||||
}
|
||||
|
||||
_openQueue.Clear();
|
||||
return dirs;
|
||||
}
|
||||
}
|
||||
|
||||
_openQueue.Clear();
|
||||
return null;
|
||||
}
|
||||
|
||||
private static int GetIndex(int x, int y, int z)
|
||||
{
|
||||
x -= _xOffset;
|
||||
y -= _yOffset;
|
||||
z += PlaneOffset;
|
||||
z /= PlaneHeight;
|
||||
|
||||
return x + y * AreaSize + z * AreaSize * AreaSize;
|
||||
}
|
||||
|
||||
private static int GetSuccessors(int p, Mobile m, Map map)
|
||||
{
|
||||
var px = p % AreaSize;
|
||||
var py = p / AreaSize % AreaSize;
|
||||
var pz = _nodes[p].z;
|
||||
|
||||
var p3D = new Point3D(px + _xOffset, py + _yOffset, pz);
|
||||
|
||||
var vals = _successors;
|
||||
var count = 0;
|
||||
|
||||
for (var i = 0; i < 8; ++i)
|
||||
{
|
||||
int x;
|
||||
int y;
|
||||
switch (i)
|
||||
{
|
||||
default: // 0
|
||||
x = 0;
|
||||
y = -1;
|
||||
break;
|
||||
case 1:
|
||||
x = 1;
|
||||
y = -1;
|
||||
break;
|
||||
case 2:
|
||||
x = 1;
|
||||
y = 0;
|
||||
break;
|
||||
case 3:
|
||||
x = 1;
|
||||
y = 1;
|
||||
break;
|
||||
case 4:
|
||||
x = 0;
|
||||
y = 1;
|
||||
break;
|
||||
case 5:
|
||||
x = -1;
|
||||
y = 1;
|
||||
break;
|
||||
case 6:
|
||||
x = -1;
|
||||
y = 0;
|
||||
break;
|
||||
case 7:
|
||||
x = -1;
|
||||
y = -1;
|
||||
break;
|
||||
}
|
||||
|
||||
x += px;
|
||||
y += py;
|
||||
|
||||
if (x is < 0 or >= AreaSize || y is < 0 or >= AreaSize)
|
||||
{
|
||||
continue;
|
||||
}
|
||||
|
||||
if (CalcMoves.CheckMovement(m, map, p3D, (Direction)i, out var z))
|
||||
{
|
||||
var idx = GetIndex(x + _xOffset, y + _yOffset, z);
|
||||
|
||||
if (idx >= 0 && idx < NodeCount)
|
||||
{
|
||||
_nodes[idx].z = z;
|
||||
vals[count++] = idx;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return count;
|
||||
}
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue