A simple A* path finding written in C#