C# Pathfinding Tool