Add SPT for Dijkstra U + unit tests.

WARNING: shortestPathTree.addEdge(u, v, e) was modifying the base graph!