Fixed bug in Dijkstra code

git-svn-id: https://svn.ices.utexas.edu/repos/clsb/trunk/moil@4750 90e2fc84-bd37-0410-82f1-ae2f889bfac2