Added and tested Dijkstra shortest path funciton