Add print() methods to print shortest paths
Graph: TODO notes