Adding graph_algorithms.hpp with dijkstra_shortest_path_to