A* Algorithm Implementation in C#