AStar C++ Implementierung