Pathfinding optimization
New pathfinding method