Used templated library in Johnson's code
Added support for destination node in Dijkstra