Full implementation of Dijkstra Shortest Path. Initial version.