Pathfinding and Graph open sourcing library for c++