A* in C++/SFML