New pathfinding algorithm