Intial version of Dijkstra's is passing a simple test. More testing to do