Matlab Dijkstra Shortest Path