A* pathfinding algorithm help - C#