Having an issue implementing A* pathfinding - C#