Add graph.hpp and implement Dijkstra alg.