Advanced Pathfinding for C#