Sample implementation of Dijkstra's shortest path algorithm